Transform pose data to different coordinate system

391 views Asked by At

I have a pose (position as 3d vector + orientation as quaternion or RPY) sensor that streams data with respect to a known coordinate system. The translations and rotations are relative to those 3 known space axis, let's call it "world".

I would like however to get the relative translations and rotations with respect to another coordinate system, in which the origin happens to be the same as world but the axis are rotated by known angles. For the translations, a simple rotation matrix can transform an (x,y,z) 3d position from the world coordinate system to a new, rotated one by knowing the roll, pitch and yaw rotations.

But how could I get the rotations with respect to my coordinate system? Rotating around one world axis will result in 2 or 3 custom coordinate rotations. How can I transform the rotations, any ideas?

0

There are 0 answers