Can't display occupied voxels octomap using pointcloud2

Fairly new to this so let me know if there's a better way of doing things! I'm attempting dynamic collision avoidance with a Kinect V1 and the ur5 moveit package on ROS kinetic. The PC is running Ubuntu 16.04 and i have the following packages installed: - camera_pose - octomap_mapping - octomap_ros - OpenNI - openni_camera - perception_pcl - robotiq - trac_ik - universal_robot - ur_modern_driver - ur_scripts I've been following the ROS tutorial on perception/configuration (link below) in an effort to have moveit process the point cloud into an octomap and display the occupied voxels: http://docs.ros.org/kinetic/api/moveit_tutorials/html/doc/perception_configuration/perception_configuration_tutorial.html And am also aware of this other thread which is extremely similar, however i wasn't able to achieve a working result using just the information here: https://answers.ros.org/question/195770/moveit-collision-avoidance-with-point-cloud-2/ I have Openni working so can visualise the pointcloud2 okay in moveit and have completed all the steps in the above, including altering the sensor_manager.launch.yaml files. However when i echo the planning scene topic, `/move_group/monitored_planning_scene`, i am getting nothing. This is despite trying a number of static transform publishers to arrange everything with respect to `/world` (I would post images of my tf trees but i dont have enough karma). **The moveit! config files used can be found at: (https://github.com/nis-ur/ur_kinect_meta/tree/master)** **As requested, the terminal log when i launch ur5 planning:** nvidia@tegra-ubuntu:~/catkin_ws$ roslaunch ur5_moveit_config ur5_moveit_planning_execution.launch sim:=true limited:=true ... logging to /home/nvidia/.ros/log/6ae42ada-891a-11e8-b1d3-62c9d7ce9d78/roslaunch-tegra-ubuntu-7323.log Checking log directory for disk usage. This may take awhile. Press Ctrl-C to interrupt Done checking log file disk usage. Usage is <1GB. started roslaunch server http://tegra-ubuntu:38298/ SUMMARY ======== PARAMETERS * /move_group/Manipulator/longest_valid_segment_fraction: 0.005 * /move_group/Manipulator/planner_configs: ['SBLkConfigDefau... * /move_group/Manipulator/projection_evaluator: joints(shoulder_p... * /move_group/allow_trajectory_execution: True * /move_group/controller_list: [{'action_ns': 'f... * /move_group/jiggle_fraction: 0.05 * /move_group/max_range: 5.0 * /move_group/max_safe_path_cost: 1 * /move_group/moveit_controller_manager: moveit_simple_con... * /move_group/moveit_manage_controllers: True * /move_group/octomap_resolution: 0.025 * /move_group/planner_configs/BFMTkConfigDefault/balanced: 0 * /move_group/planner_configs/BFMTkConfigDefault/cache_cc: 1 * /move_group/planner_configs/BFMTkConfigDefault/extended_fmt: 1 * /move_group/planner_configs/BFMTkConfigDefault/heuristics: 1 * /move_group/planner_configs/BFMTkConfigDefault/nearest_k: 1 * /move_group/planner_configs/BFMTkConfigDefault/num_samples: 1000 * /move_group/planner_configs/BFMTkConfigDefault/optimality: 1 * /move_group/planner_configs/BFMTkConfigDefault/radius_multiplier: 1.0 * /move_group/planner_configs/BFMTkConfigDefault/type: geometric::BFMT * /move_group/planner_configs/BKPIECEkConfigDefault/border_fraction: 0.9 * /move_group/planner_configs/BKPIECEkConfigDefault/failed_expansion_score_factor: 0.5 * /move_group/planner_configs/BKPIECEkConfigDefault/min_valid_path_fraction: 0.5 * /move_group/planner_configs/BKPIECEkConfigDefault/range: 0.0 * /move_group/planner_configs/BKPIECEkConfigDefault/type: geometric::BKPIECE * /move_group/planner_configs/BiESTkConfigDefault/range: 0.0 * /move_group/planner_configs/BiESTkConfigDefault/type: geometric::BiEST * /move_group/planner_configs/BiTRRTkConfigDefault/cost_threshold: 1e300 * /move_group/planner_configs/BiTRRTkConfigDefault/frountier_node_ratio: 0.1 * /move_group/planner_configs/BiTRRTkConfigDefault/frountier_threshold: 0.0 * /move_group/planner_configs/BiTRRTkConfigDefault/init_temperature: 100 * /move_group/planner_configs/BiTRRTkConfigDefault/range: 0.0 * /move_group/planner_configs/BiTRRTkConfigDefault/temp_change_factor: 0.1 * /move_group/planner_configs/BiTRRTkConfigDefault/type: geometric::BiTRRT * /move_group/planner_configs/ESTkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/ESTkConfigDefault/range: 0.0 * /move_group/planner_configs/ESTkConfigDefault/type: geometric::EST * /move_group/planner_configs/FMTkConfigDefault/cache_cc: 1 * /move_group/planner_configs/FMTkConfigDefault/extended_fmt: 1 * /move_group/planner_configs/FMTkConfigDefault/heuristics: 0 * /move_group/planner_configs/FMTkConfigDefault/nearest_k: 1 * /move_group/planner_configs/FMTkConfigDefault/num_samples: 1000 * /move_group/planner_configs/FMTkConfigDefault/radius_multiplier: 1.1 * /move_group/planner_configs/FMTkConfigDefault/type: geometric::FMT * /move_group/planner_configs/KPIECEkConfigDefault/border_fraction: 0.9 * /move_group/planner_configs/KPIECEkConfigDefault/failed_expansion_score_factor: 0.5 * /move_group/planner_configs/KPIECEkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/KPIECEkConfigDefault/min_valid_path_fraction: 0.5 * /move_group/planner_configs/KPIECEkConfigDefault/range: 0.0 * /move_group/planner_configs/KPIECEkConfigDefault/type: geometric::KPIECE * /move_group/planner_configs/LBKPIECEkConfigDefault/border_fraction: 0.9 * /move_group/planner_configs/LBKPIECEkConfigDefault/min_valid_path_fraction: 0.5 * /move_group/planner_configs/LBKPIECEkConfigDefault/range: 0.0 * /move_group/planner_configs/LBKPIECEkConfigDefault/type: geometric::LBKPIECE * /move_group/planner_configs/LBTRRTkConfigDefault/epsilon: 0.4 * /move_group/planner_configs/LBTRRTkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/LBTRRTkConfigDefault/range: 0.0 * /move_group/planner_configs/LBTRRTkConfigDefault/type: geometric::LBTRRT * /move_group/planner_configs/LazyPRMkConfigDefault/range: 0.0 * /move_group/planner_configs/LazyPRMkConfigDefault/type: geometric::LazyPRM * /move_group/planner_configs/LazyPRMstarkConfigDefault/type: geometric::LazyPR... * /move_group/planner_configs/PDSTkConfigDefault/type: geometric::PDST * /move_group/planner_configs/PRMkConfigDefault/max_nearest_neighbors: 10 * /move_group/planner_configs/PRMkConfigDefault/type: geometric::PRM * /move_group/planner_configs/PRMstarkConfigDefault/type: geometric::PRMstar * /move_group/planner_configs/ProjESTkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/ProjESTkConfigDefault/range: 0.0 * /move_group/planner_configs/ProjESTkConfigDefault/type: geometric::ProjEST * /move_group/planner_configs/RRTConnectkConfigDefault/range: 0.0 * /move_group/planner_configs/RRTConnectkConfigDefault/type: geometric::RRTCon... * /move_group/planner_configs/RRTkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/RRTkConfigDefault/range: 0.0 * /move_group/planner_configs/RRTkConfigDefault/type: geometric::RRT * /move_group/planner_configs/RRTstarkConfigDefault/delay_collision_checking: 1 * /move_group/planner_configs/RRTstarkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/RRTstarkConfigDefault/range: 0.0 * /move_group/planner_configs/RRTstarkConfigDefault/type: geometric::RRTstar * /move_group/planner_configs/SBLkConfigDefault/range: 0.0 * /move_group/planner_configs/SBLkConfigDefault/type: geometric::SBL * /move_group/planner_configs/SPARSkConfigDefault/dense_delta_fraction: 0.001 * /move_group/planner_configs/SPARSkConfigDefault/max_failures: 1000 * /move_group/planner_configs/SPARSkConfigDefault/sparse_delta_fraction: 0.25 * /move_group/planner_configs/SPARSkConfigDefault/stretch_factor: 3.0 * /move_group/planner_configs/SPARSkConfigDefault/type: geometric::SPARS * /move_group/planner_configs/SPARStwokConfigDefault/dense_delta_fraction: 0.001 * /move_group/planner_configs/SPARStwokConfigDefault/max_failures: 5000 * /move_group/planner_configs/SPARStwokConfigDefault/sparse_delta_fraction: 0.25 * /move_group/planner_configs/SPARStwokConfigDefault/stretch_factor: 3.0 * /move_group/planner_configs/SPARStwokConfigDefault/type: geometric::SPARStwo * /move_group/planner_configs/STRIDEkConfigDefault/degree: 16 * /move_group/planner_configs/STRIDEkConfigDefault/estimated_dimension: 0.0 * /move_group/planner_configs/STRIDEkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/STRIDEkConfigDefault/max_degree: 18 * /move_group/planner_configs/STRIDEkConfigDefault/max_pts_per_leaf: 6 * /move_group/planner_configs/STRIDEkConfigDefault/min_degree: 12 * /move_group/planner_configs/STRIDEkConfigDefault/min_valid_path_fraction: 0.2 * /move_group/planner_configs/STRIDEkConfigDefault/range: 0.0 * /move_group/planner_configs/STRIDEkConfigDefault/type: geometric::STRIDE * /move_group/planner_configs/STRIDEkConfigDefault/use_projected_distance: 0 * /move_group/planner_configs/TRRTkConfigDefault/frountierNodeRatio: 0.1 * /move_group/planner_configs/TRRTkConfigDefault/frountier_threshold: 0.0 * /move_group/planner_configs/TRRTkConfigDefault/goal_bias: 0.05 * /move_group/planner_configs/TRRTkConfigDefault/init_temperature: 10e-6 * /move_group/planner_configs/TRRTkConfigDefault/k_constant: 0.0 * /move_group/planner_configs/TRRTkConfigDefault/max_states_failed: 10 * /move_group/planner_configs/TRRTkConfigDefault/min_temperature: 10e-10 * /move_group/planner_configs/TRRTkConfigDefault/range: 0.0 * /move_group/planner_configs/TRRTkConfigDefault/temp_change_factor: 2.0 * /move_group/planner_configs/TRRTkConfigDefault/type: geometric::TRRT * /move_group/planning_plugin: ompl_interface/OM... * /move_group/planning_scene_monitor/publish_geometry_updates: True * /move_group/planning_scene_monitor/publish_planning_scene: True * /move_group/planning_scene_monitor/publish_state_updates: True * /move_group/planning_scene_monitor/publish_transforms_updates: True * /move_group/request_adapters: default_planner_r... * /move_group/start_state_max_bounds_error: 0.1 * /move_group/trajectory_execution/allowed_execution_duration_scaling: 1.2 * /move_group/trajectory_execution/allowed_goal_duration_margin: 0.5 * /move_group/trajectory_execution/allowed_start_tolerance: 0.01 * /move_group/trajectory_execution/execution_duration_monitoring: False * /move_group/use_controller_manager: False * /robot_description_kinematics/Manipulator/kinematics_solver: trac_ik_kinematic... * /robot_description_kinematics/Manipulator/kinematics_solver_attempts: 3 * /robot_description_kinematics/Manipulator/kinematics_solver_search_resolution: 0.005 * /robot_description_kinematics/Manipulator/kinematics_solver_timeout: 0.02 * /robot_description_planning/joint_limits/elbow_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/elbow_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/elbow_joint/max_acceleration: 0 * /robot_description_planning/joint_limits/elbow_joint/max_velocity: 3.15 * /robot_description_planning/joint_limits/shoulder_lift_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/shoulder_lift_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/shoulder_lift_joint/max_acceleration: 0 * /robot_description_planning/joint_limits/shoulder_lift_joint/max_velocity: 3.15 * /robot_description_planning/joint_limits/shoulder_pan_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/shoulder_pan_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/shoulder_pan_joint/max_acceleration: 0 * /robot_description_planning/joint_limits/shoulder_pan_joint/max_velocity: 3.15 * /robot_description_planning/joint_limits/wrist_1_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/wrist_1_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/wrist_1_joint/max_acceleration: 0 * /robot_description_planning/joint_limits/wrist_1_joint/max_velocity: 3.2 * /robot_description_planning/joint_limits/wrist_2_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/wrist_2_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/wrist_2_joint/max_acceleration: 0 * /robot_description_planning/joint_limits/wrist_2_joint/max_velocity: 3.2 * /robot_description_planning/joint_limits/wrist_3_joint/has_acceleration_limits: False * /robot_description_planning/joint_limits/wrist_3_joint/has_velocity_limits: True * /robot_description_planning/joint_limits/wrist_3_joint/max_acceleration: 0 * /robot_description_planning/joint_limits/wrist_3_joint/max_velocity: 3.2 * /robot_description_semantic: