diff --git a/realsense2_description/urdf/_d435i_imu_modules.gazebo.xacro b/realsense2_description/urdf/_d435i_imu_modules.gazebo.xacro
index fcf80f8d3..454d877ca 100644
--- a/realsense2_description/urdf/_d435i_imu_modules.gazebo.xacro
+++ b/realsense2_description/urdf/_d435i_imu_modules.gazebo.xacro
@@ -10,7 +10,7 @@ Intel RealSense 435i camera.
-
+
1
@@ -72,26 +72,23 @@ Intel RealSense 435i camera.
+
+
+ ~/out:=${camera_name}/gyro/data_raw
+
+ ${gyro_optical_frame}
+ false
+
+
+
+ ~/out:=${camera_name}/accel/data_raw
+
+ ${accel_optical_frame}
+ false
+
-
-
-
- ~/out:=${camera_name}/camera/gyro/sample
-
- ${gyro_optical_frame}
- false
-
-
-
- ~/out:=${camera_name}/camera/accel/sample
-
- ${accel_optical_frame}
- false
-
-
-
diff --git a/realsense2_description/urdf/_d455.gazebo.xacro b/realsense2_description/urdf/_d455.gazebo.xacro
index fc117a1a5..18efa5e71 100644
--- a/realsense2_description/urdf/_d455.gazebo.xacro
+++ b/realsense2_description/urdf/_d455.gazebo.xacro
@@ -3,10 +3,10 @@
-
+
-
-
+
+
@@ -169,6 +169,20 @@ This is the Gazebo URDF model for the Intel RealSense D455 camera
+
+
+ ~/out:=${camera_name}/gyro/data_raw
+
+ ${gyro_optical_frame}
+ false
+
+
+
+ ~/out:=${camera_name}/accel/data_raw
+
+ ${accel_optical_frame}
+ false
+
@@ -197,20 +211,6 @@ This is the Gazebo URDF model for the Intel RealSense D455 camera
0.25
9.0
-
-
- ~/out:=${camera_name}/camera/gyro/sample
-
- ${gyro_optical_frame}
- false
-
-
-
- ~/out:=${camera_name}/camera/accel/sample
-
- ${accel_optical_frame}
- false
-