mirror of
https://github.com/orbbec/OrbbecSDK_ROS2.git
synced 2026-10-08 22:07:46 +08:00
Update the point cloud y axis
This commit is contained in:
@@ -778,7 +778,7 @@ void OBLidarNode::publishPointCloud(std::shared_ptr<ob::FrameSet> 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<float>(point_data[i].x / 1000.0);
|
||||
*iter_y = static_cast<float>(point_data[i].y / -1000.0);
|
||||
*iter_y = static_cast<float>(point_data[i].y / 1000.0);
|
||||
*iter_z = static_cast<float>(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<ob::FrameSet> 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<float>(result_point[i].x / 1000.0);
|
||||
*iter_y = static_cast<float>(result_point[i].y / -1000.0);
|
||||
*iter_y = static_cast<float>(result_point[i].y / 1000.0);
|
||||
*iter_z = static_cast<float>(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<float>(point_data[i].x / 1000.0);
|
||||
*iter_y = static_cast<float>(point_data[i].y / -1000.0);
|
||||
*iter_y = static_cast<float>(point_data[i].y / 1000.0);
|
||||
*iter_z = static_cast<float>(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<float>(result_point[i].x / 1000.0);
|
||||
*iter_y = static_cast<float>(result_point[i].y / -1000.0);
|
||||
*iter_y = static_cast<float>(result_point[i].y / 1000.0);
|
||||
*iter_z = static_cast<float>(result_point[i].z / 1000.0);
|
||||
*iter_intensity = result_point[i].intensity;
|
||||
*iter_tag = result_point[i].tag;
|
||||
|
||||
Reference in New Issue
Block a user