diff --git a/orbbec_camera/src/ob_lidar_node.cpp b/orbbec_camera/src/ob_lidar_node.cpp index 76d5ccf1..7257a7d5 100644 --- a/orbbec_camera/src/ob_lidar_node.cpp +++ b/orbbec_camera/src/ob_lidar_node.cpp @@ -778,7 +778,7 @@ void OBLidarNode::publishPointCloud(std::shared_ptr frame_set) { for (size_t i = 0; i < point_count; ++i, ++iter_x, ++iter_y, ++iter_z, ++iter_intensity, ++iter_tag) { *iter_x = static_cast(point_data[i].x / 1000.0); - *iter_y = static_cast(point_data[i].y / -1000.0); + *iter_y = static_cast(point_data[i].y / 1000.0); *iter_z = static_cast(point_data[i].z / 1000.0); *iter_intensity = point_data[i].intensity; *iter_tag = point_data[i].tag; @@ -822,7 +822,7 @@ void OBLidarNode::publishSpherePointCloud(std::shared_ptr frame_se for (size_t i = 0; i < point_count; ++i, ++iter_x, ++iter_y, ++iter_z, ++iter_intensity, ++iter_tag) { *iter_x = static_cast(result_point[i].x / 1000.0); - *iter_y = static_cast(result_point[i].y / -1000.0); + *iter_y = static_cast(result_point[i].y / 1000.0); *iter_z = static_cast(result_point[i].z / 1000.0); *iter_intensity = result_point[i].intensity; *iter_tag = result_point[i].tag; @@ -903,7 +903,7 @@ void OBLidarNode::publishMergedPointCloud() { for (size_t i = 0; i < point_count; ++i, ++iter_x, ++iter_y, ++iter_z, ++iter_intensity, ++iter_tag, ++iter_offset_time) { *iter_x = static_cast(point_data[i].x / 1000.0); - *iter_y = static_cast(point_data[i].y / -1000.0); + *iter_y = static_cast(point_data[i].y / 1000.0); *iter_z = static_cast(point_data[i].z / 1000.0); *iter_intensity = point_data[i].intensity; *iter_tag = point_data[i].tag; @@ -998,7 +998,7 @@ void OBLidarNode::publishMergedSpherePointCloud() { for (size_t i = 0; i < point_count; ++i, ++iter_x, ++iter_y, ++iter_z, ++iter_intensity, ++iter_tag, ++iter_offset_time) { *iter_x = static_cast(result_point[i].x / 1000.0); - *iter_y = static_cast(result_point[i].y / -1000.0); + *iter_y = static_cast(result_point[i].y / 1000.0); *iter_z = static_cast(result_point[i].z / 1000.0); *iter_intensity = result_point[i].intensity; *iter_tag = result_point[i].tag;