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

Moveit can't execute a plan with MoveGroupInterface

asked 2020-04-24 13:48:44 -0500

edote gravatar image


I am trying to move a group from my own robot with a joint goal, with the MoveGroupInterface class. When I use move() the group moves perfectly to the joint goal in rviz.

Now I want to add constraints and time parameterization, so I generated a plan with the planning pipeline :

planning_pipeline->generatePlan(planning_scene, req, res);

The trajectory created is correct, but when I try to execute it in Rviz the robot doesn't move, even though I get a "SUCCEED" message for the execution.

How can I execute and visualize a trajectory created with the planning pipeline ? I tried several methods from the moveit tutorials, and never got a result. Thanks

I use :

Ubuntu 18.04 ROS melodic (from binaries) Moveit (from binaries)

I use the demo.launch file.

My code :

planning_pipeline->generatePlan(planning_scene, req, res); robot_trajectory::RobotTrajectory trajectory = *res.trajectory_; vector <string> joint_names = {"J1_right", "J2_right", "J3_right", "J4_right"};

moveit_msgs::RobotTrajectory trajectory_msg;

moveit::planning_interface::MoveGroupInterface move_group(group);    
moveit::planning_interface::MoveGroupInterface::Plan plan;
plan.trajectory_ = trajectory_msg;
plan.trajectory_.joint_trajectory.header.stamp = ros::Time::now();
plan.trajectory_.joint_trajectory.header.frame_id = trajectory_msg.joint_trajectory.header.frame_id;
plan.trajectory_.joint_trajectory.joint_names = joint_names;

cout<<"EXECUTE PLAN"<<endl;
move_group.plan(plan);       // I tried with .plan(), without .plan(), and with .move()

Console output :

[ INFO] [1587753968.681163408]: Looking around: no [ INFO] [1587753968.681232961]: Replanning: no [ INFO] [1587754003.859250207]: Execution request received [ INFO] [1587754003.930022457]: Fake execution of trajectory [ INFO] [1587754004.229404023]: Completed trajectory execution with status SUCCEEDED ... [ INFO] [1587754004.229801013]: Execution completed: SUCCEEDED

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2020-05-22 10:50:34 -0500

edote gravatar image

updated 2020-05-25 02:02:33 -0500

I don't remember why, but the variable time_from_start in plan.trajectory_.joint_trajectory.points[] was empty, so my robot jumped from start state to goal state but the trajectory didn't have the time to execute. Now I use res.getMessage(response) (, and it works.

edit flag offensive delete link more

Question Tools



Asked: 2020-04-24 13:48:44 -0500

Seen: 1,032 times

Last updated: May 25 '20