pub fn ksi<T: Float>(angle: T, x: T, y: T) -> M33<T>
Create a pose in 2D from a angle(in radians) and a cartesian position (x, y) values