It seems like the quaternion formed in the IMU message under case OutputAxisOptions::ROBOT_FRAME might be incorrect? For example, when observing velocity in the +yaw direction I am seeing a -yaw change in the orientation. I believe the same is true for pitch. It seems like the correct orientation (to match the accelerations and velocities) would be a 180 degree rotation around the x-axis.
This is assuming that the correct ROBOT_FRAME is (X/Y/Z) == (Front/Left/Up)
It seems like the quaternion formed in the IMU message under
case OutputAxisOptions::ROBOT_FRAME
might be incorrect? For example, when observing velocity in the+yaw
direction I am seeing a-yaw
change in the orientation. I believe the same is true for pitch. It seems like the correct orientation (to match the accelerations and velocities) would be a 180 degree rotation around the x-axis.This is assuming that the correct
ROBOT_FRAME
is (X/Y/Z) == (Front/Left/Up)