The gripper always collide to object when motion planning in moveit

asked 2019-10-28 09:31:32 -0600

A_YIng gravatar image

Hello,

I tried to use moveit motion planning API to do picking and placing task. When I tried to approach my object, the planner always say it occur collision and failed.

[ INFO] [1572272017.376712612]: Planner configuration 'r1' will use planner 'geometric::RRTConnect'. Additional configuration parameters will be set when the planner is constructed.
[ INFO] [1572272017.376888070]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1572272017.658415351]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.658472166]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.658563486]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.658579389]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.658679813]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.658691351]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.658775652]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.658786130]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.658872482]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.658882703]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.658969226]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.658979052]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.659074077]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.659084620]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1572272017.659162838]: Found a contact between 'mouse' (type 'Object') and 'r1_eef_base_link' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1572272017.659174710]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ERROR] [1572272017.960710946]: RRTConnect: Unable to sample any valid states for goal tree
[ INFO] [1572272017.960748823]: RRTConnect: Created 1 states (1 start + 0 goal)
[ INFO] [1572272017.960764057]: No solution found after 0.583973 seconds
[ INFO] [1572272017.960788859]: Unable to solve the planning problem

I just use planner to let robot move down vertically by approaching distance.

However, it is normal at rviz interactive function.

image description

Does anyone know how to deal with this situation? Thanks.

edit retag flag offensive close merge delete