planning with orientation constraint in moveit

asked 2015-02-24 02:32:09 -0500

chpark gravatar image

Hi, I set an end-effector orientation constraint for planning using Moveit, but computed motions have some jerky points.

with RRT (OMPL) : http://youtu.be/waVhHUCFRvo with RRT* (OMPL) : http://youtu.be/5vDLr5XhvJQ

It looks the configuration suddenly changes to another IK solution in such points. What should I do to get smooth trajectories?

I am using ROS Hydro and Moveit. I used below code for setting the orientation constraint.

moveit_msgs::OrientationConstraint ocm;
ocm.link_name = "end_effector_link";
ocm.header.frame_id = "segment_0";
ocm.orientation.x = 0;
ocm.orientation.y = 0;
ocm.orientation.z = -INV_SQRT_2;
ocm.orientation.w = INV_SQRT_2;
ocm.absolute_x_axis_tolerance = 0.5;
ocm.absolute_y_axis_tolerance = 0.5;
ocm.absolute_z_axis_tolerance = M_PI;
ocm.weight = 1.0;
req.path_constraints.orientation_constraints.push_back(ocm);
edit retag flag offensive close merge delete

Comments

I am struggling with orientation constraints and I am also working with a Kuka arm. Did you managed to make it work properly under MoveIt ?

sangfuu gravatar imagesangfuu ( 2016-01-12 09:59:54 -0500 )edit
Mehdi. gravatar imageMehdi. ( 2019-07-23 12:59:00 -0500 )edit