Odometry updated... Except for quaternion conversions...