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 r
