Skip to content

Commit 6105c8b

Browse files
committed
fixed up realsense coordinate system
1 parent 38b3533 commit 6105c8b

File tree

1 file changed

+6
-6
lines changed

1 file changed

+6
-6
lines changed

Runtime/Scripts/ROS/Unity/Publishers/ZOROSIMUPublisher.cs

Lines changed: 6 additions & 6 deletions
Original file line numberDiff line numberDiff line change
@@ -149,13 +149,13 @@ private Task OnPublishImuDelegate(ZOIMU lidar, string name, Vector3 linearAccel,
149149
_imuMessage.orientation.z = flippedYOrientation.z;
150150
_imuMessage.orientation.w = -flippedYOrientation.w; // negate left to right handed coordinate system
151151

152-
_imuMessage.linear_acceleration.x = -linearAccel.x + gravity.x;
153-
_imuMessage.linear_acceleration.y = linearAccel.y + gravity.y;
154-
_imuMessage.linear_acceleration.z = -linearAccel.z + gravity.z;
152+
_imuMessage.linear_acceleration.x = linearAccel.x + gravity.x;
153+
_imuMessage.linear_acceleration.y = -linearAccel.y + gravity.y;
154+
_imuMessage.linear_acceleration.z = linearAccel.z + gravity.z;
155155

156-
_imuMessage.angular_velocity.x = angularVelocity.x;
157-
_imuMessage.angular_velocity.y = angularVelocity.y;
158-
_imuMessage.angular_velocity.z = angularVelocity.z;
156+
_imuMessage.angular_velocity.x = -angularVelocity.x; // pitch
157+
_imuMessage.angular_velocity.y = angularVelocity.y; // yaw
158+
_imuMessage.angular_velocity.z = -angularVelocity.z; // roll
159159

160160
} else if (CoordinateSystem == CoordinateSystemEnum.Unity_LeftHanded_XRight_YUp_ZForward) {
161161
_imuMessage.orientation.x = orientation.x;

0 commit comments

Comments
 (0)