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

ros::moveit adding rotation to xyz-coordinates

asked 2017-06-11 06:57:30 -0500

Felix_N gravatar image

Hello people,

I am currently programming a 6 DOF robotic arm using ros and moveit for the navigation. My goals are to send x,y,z coordinates as well as a fixed orientation of my gripper in order to succesfully grab certain objects.

Following the tutorial i can send x,y,z coordinates like this just fine:

geometry_msgs::Pose target_pose1;
target_pose1.orientation.w = 1;
target_pose1.position.x = 0;
target_pose1.position.y = 0;
target_pose1.position.z = 0.55;

Using this method, my end effector stays in its start orientation.

I can also send a effector orientation like this:


However, now i the orientation changes to the given values but the x,y,z-coordinates seem rather random.

Using both commands in a row, the sedond one overwrites the first one, leading to an insufficient result.

Right now I am stuck messing around with quaternion transformation using the tf package not knowing whether this is is the right way at all. Seems like this package is unable to combine both position and orientation as well.

Does somebody know a way to send x,y,z-coordinates AND rpy-orientations (c++)?

Thank you in advance,


edit retag flag offensive close merge delete


Setting a pose target is the correct way to do it. However, you have to make sure of two things. First, the pose must be reachable but the end-effector. Secondly, the quaternion must be valid, and accurate to a fair number of decimal places (6+). Ensure both of these are satisfied, then report back.

ufr3c_tjc gravatar image ufr3c_tjc  ( 2017-06-11 18:22:51 -0500 )edit

1 Answer

Sort by ยป oldest newest most voted

answered 2017-06-12 05:24:18 -0500

Felix_N gravatar image

updated 2017-06-12 05:26:36 -0500

I found the mistake myself.

Seems like i lacked basic understanding of the geometry message. But for other beginners like me, heres the solution:

Given values of the goal position are cx,cy,cz coordinates as well as orientations rotx, roty, rotz. The move group needs the message type "geometry_msgs::Pose" which again needs the orientation as a quaternion instead of euler angles.

So the steps are the following:

  1. Generate a quaternion object
  2. Transform euler angles into the quaternion
  3. Write coordinates as well as the quaternion items into the Pose message
  4. Set and plan the goal

The code looks like this:

#include <tf/transform_datatypes.h>

tf::Quaternion q;


geometry_msgs::Pose target_pose1;
target_pose1.position.x = cx;
target_pose1.position.y = cy;
target_pose1.position.z = cz;   
target_pose1.orientation.x = q.x();
target_pose1.orientation.y = q.y();
target_pose1.orientation.z = q.z();
target_pose1.orientation.w = q.w();


moveit::planning_interface::MoveGroupInterface::Plan my_plan;

Thanks to anyone, who took his/her time to read this anyway.

edit flag offensive delete link more


Thank you for your answer. I have the same problem. What robot are youusing? What values are you using for the rotx/y/z? radiants? w must be 1, right?

UR5e gravatar image UR5e  ( 2019-10-18 02:50:23 -0500 )edit

Question Tools

1 follower


Asked: 2017-06-11 06:57:30 -0500

Seen: 2,684 times

Last updated: Jun 12 '17