i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-06 09:47:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

fixed #450

Browse Source
This commit is contained in:
matlabbe
2020-08-06 09:15:28 -04:00
parent 2806baee55
commit e96f72d4ab
2 changed files with 9 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/WifiSignalSubNode.cpp
+6 -2
View File
@@ -241,7 +241,10 @@ void mapDataCallback(const rtabmap_ros::MapDataConstPtr & mapDataMsg)
int quality = dBm2Quality(iter->second)*120/100;
float r,g,b;
HSVtoRGB(&r,&g,&b,quality,1,1);
pcl::PointXYZRGB anchor(r*255, g*255, b*255);
pcl::PointXYZRGB anchor;
anchor.r = r*255;
anchor.g = g*255;
anchor.b = b*255;
cloud->push_back(anchor);
}
else
@@ -272,7 +275,8 @@ void mapDataCallback(const rtabmap_ros::MapDataConstPtr & mapDataMsg)
}
cloud->push_back(pt);
}
pcl::PointXYZRGB anchor(255, 0, 0);
pcl::PointXYZRGB anchor;
anchor.r = 255;
cloud->push_back(anchor);
}