moveit / moveit2

:robot: MoveIt for ROS 2
https://moveit.ai/
BSD 3-Clause "New" or "Revised" License
1.05k stars 516 forks source link

Motion planning cannot avoid Octomap in planning scene #444

Closed PrakarnJ closed 3 years ago

PrakarnJ commented 3 years ago

Description

I am working on robot motion planning with perception from point cloud topic (3d camera). I found that when I planned robot path, the robot cannot avoid the collision in planning scene as shown in Figure 1.

I tried to solve this problem and found that one of the solution is it need to add something to planning scene using Scene objects tab UI and push Publish button as shown in Figure Screenshot from 2021-04-28 20-49-43

After that I planned robot path again and you can see robot can avoid the obstacle 3.

Do anyone have the way to solve this problem or the way to check this issue?

Your environment

swilcock0 commented 3 years ago

This looks like #407 and #429

henningkayser commented 3 years ago

This doesn't look like #407 to me, but it might really be related to #429 which also looks like planning scene updates not being synced properly. I'll check if there is something odd going on, collision checking working after the manual update is very suspicious.

swilcock0 commented 3 years ago

@henningkayser the manual update thing is the same with #407

JafarAbdi commented 3 years ago

@PrakarnJ Could you please try https://github.com/ros-planning/moveit2/pull/456 and see if it fixes it .?

PrakarnJ commented 3 years ago

@JafarAbdi Yeah It can fixed.