ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

Attaching Object to Robot and then use with move_arm package

asked 2012-07-30 00:00:28 -0500

clantos gravatar image

updated 2014-01-28 17:13:11 -0500

ngrennan gravatar image

Hello all,

I am using the move_arm package to plan and execute trajectories for the arm of the KUKA youbot robot. Everything is working fine.

In some cases, I want to pick up a cube and place it on the back of the youbot. So when I pick the cube, I am adding it as an attached object on the robot using the code from the Attaching Virtual Objects to the Robot tutorial, in order to avoid collisions when I am going to place it on the back of the youbot. However, when I call the move_arm action server afterwards to move the arm to the place position the attached object is not taken into consideration for the trajectory plan.

I call the get_planning_scene service with the attached object and then I call the set_planning_scene_diff service with the resulted planning scene. This is not suppose to forward the updated scene to all components?

arm_navigation_msgs::GetPlanningScene planning_scene;
    ROS_WARN("Can't get planning scene");
    return false;

arm_navigation_msgs::SetPlanningSceneDiff srv;
srv.request.planning_scene_diff = planning_scene.response.planning_scene;
    ROS_WARN("Can't set planning scene");
    return false;

PS. The planning scene from the response contains the object. I validate it using the collision models and visualise the attached collision objects markers.

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2012-07-30 06:30:04 -0500

egiljones gravatar image

move_arm also calls SetPlanningSceneDiff, so if you want to supply a diff to it you need to set the planning_scene_diff field in the MoveArmGoal. You shouldn't actually need the other two calls to the environment server - just put the attached object in the MoveArmGoal.planning_scene_diff and you should get the desired behavior.

edit flag offensive delete link more


Thank you very much!!! Didn't notice that MoveArmGoal had a planning_scene_diff :)

clantos gravatar image clantos  ( 2012-07-30 23:08:51 -0500 )edit

Question Tools


Asked: 2012-07-30 00:00:28 -0500

Seen: 253 times

Last updated: Jul 30 '12