Hello all,

I am quite new with Universal Robots. I am currently using the UR 10. I am trying to figure out how to achieve the following,

I have a set of waypoints represented in cartesian poses. I would like to shift these set of waypoints to a new pose and orientation by using a new start pose which is also in Cartesian coordinates.

Currently, I tried the following steps
1. Calculate the offsets between each consecutive poses using pose_sub() function
2. Add these offsets to the new start pose using pose_add() function

But, when i run the program, the translation seems to work fine but the orientation remains same as the old set of waypoints.

I feel that pose_sub() is not the right way to do it. Could someone please guide me in this issue?

Thanks and Regards
Anand

Pose_sub and pose_add work in base coordinates. You will want to use pose_trans when you add the deltas to your new starting position. That should fix the issue of orientation. 

Thank you so much for the quick response @matthewd92. :)

So, you are telling that my approach of using the pose_sub(pose1,pose2) function to calculate the offsets (difference in position and orientation) between two TCP poses is fine.

pose_trans(new_start_pose, offset_pose) instead of pose_add() to new starting position will achieve the old trajectory with new orientation.

It should. You’re getting offsets from your current starting point relative to that point and then applying those offsets on a new point relative to that point. 

@matthewd92 Thank you for your inputs. I will try them and give feedback soon! :)

Hello @matthewd92,

Update: Yes, I tested today and it is working. Thank you!

Have a great day!