ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
Found the issue:
// directly transform to map frame:
pcl::transformPointCloud(pc, pc, sensorToWorld);
I believe this was performing a transform on already transformed trajectories. By commenting this entry out, rebuilding and trying again, the insertion and ray casting are working correctly.