How to give Octomap data to the Planning Scene? (MoveIt!)

edit

Hello,

I'm relatively new to MoveIt and ROS. For the past week, I have been trying to configure the 3D sensor (a Kinect) on my robot model to work in MoveIt!, following the tutorial here. Additionally, I created a node to launch the Octomap Server.

However, after completing these steps and firing up MoveIt!/Rviz with Gazebo, the Planning Scene doesn't contain any 3D data. I have checked the topics list, and my simulated robot is publishing the correct PointCloud2 data, and the Octomap server is running and publishing correct occupancy maps. What else is needed to get Octomap to publish the data to the Planning Scene?

Code:

config/sensors_kinect.yaml

sensors:
  - sensor_plugin: occupancy_map_monitor/PointCloudOctomapUpdater
    point_cloud_topic: /kinect/depth/points
    max_range: 5.0
    point_subsample: 1
    padding_offset: 0.1
    padding_scale: 1.0
    filtered_cloud_topic: filtered_cloud

launch/sensor_manager.launch.xml

<launch>

  <rosparam command="load" file="$(find inmoov_moveit)/config/sensors_kinect.yaml" />

  <param name="octomap_frame" type="string" value="base_link" />
  <param name="octomap_resolution" type="double" value="0.025" />
  <param name="max_range" type="double" value="5.0" />

</launch>