Bugfix in get_orient_imu_updated