Hi all,
is there any documentation on what the notation for Cartesian Waypoints x,y,z,rx,ry,rz looks like?
Our convention for a "pose" is (x,y,z, Rz, Ry, Rx). We use the yaw, pitch, roll as order of rotation (Tait-Briant angles) (like is common in aerospace). For Twist we use cartesian coordinates (Vx, Vy, Vz, Wx, Wy, Wz).