diff --git a/simulation/simple_sensor_simulator/src/sensor_simulation/lidar/lidar_sensor.cpp b/simulation/simple_sensor_simulator/src/sensor_simulation/lidar/lidar_sensor.cpp index 14d4a427f2d..1d6978b8acf 100644 --- a/simulation/simple_sensor_simulator/src/sensor_simulation/lidar/lidar_sensor.cpp +++ b/simulation/simple_sensor_simulator/src/sensor_simulation/lidar/lidar_sensor.cpp @@ -36,6 +36,7 @@ auto LidarSensor::raycast( geometry_msgs::msg::Pose pose; simulation_interface::toMsg(entity.pose(), pose); ego_pose = pose; + ego_pose->position.z += entity.bounding_box().dimensions().z(); } else { geometry_msgs::msg::Pose pose; simulation_interface::toMsg(entity.pose(), pose);