Hello,

I have a robotic arm which is equipped with 3D sensor (PointCloud2 Occupancy Map Updater) to detect the world around. The path planning works fine with Moveit, the world around is detected well, the obstacle avoidance works as well.

My problem is that after the integration of the 3D sensor into Moveit the path planning has become very slow, e.g., from pointA to pointB the calculation takes 40-50 sec.

1) Can you suggest what to change in general that could speed up the path planning?

Currently the max_update_rate in the sensor.yaml file is set 2Hz (i suppose that is not a high frequency)

The default_planner_config is RRTConnect.

The robot has its own IK plugin.

2) In my configuration, the world/environment in front of the robot is static, i.e., the point cloud data provided by the sensor is "constant" (if the noise is not considered). This means that it is enough to capture only once the environment in front of the robot, since it will not change in time. I think that Moveit Perception assumes dynamic environment, that is why the max_update_rate is required. In my special case, is it possible somehow to inform the Moveit Perception that the point cloud can be considered constant in order to speed up the path planning calculation?

Thank you in advance. Best regards.