Hello guys,

i am currently working on a UR5e (Universal Robots) where I have created a C# program that reads a list of drillings (up to 600 per file) transforms them and sends them in script language to the UR5e via socket ethernet connection. Everything works fine, except for the performance of the UR5e which seems to reach its limits as it is needed to use 8 pose_trans() script functions per drill. I have contacted the Universal Robots support already and they recommended to do the calculations done by the pose trans() script function in my C# program. The function has got 2 inputs, one for the starting position of the tool, and the second one for the distance covered relative to the starting position. The output is defined as the target position, after the distance has been covered.

In order to do the calculations of the pose_trans() function in my C# program i need to know the algorithm behind it. However, so far I was not successfull searching on the zacobria and universal robots forums so far. If somebody faced a similar problem already and knows the algorithm behind this function, it would be very helpful to me.

Best regards

Thanks for your reply Kaleb,

I have taken both, the link and the description of the function in the script manual, into consideration already. However, it is not clear to me how exemplarily the result on the extract from the script manual that you posted is being calculated. 

The first point is p[0.2,0.5,0.1,1.57,0,0]
The second point is p[0.2,0.5,0.6,1.57,0,0]
And the result is p[0.4,-0.0996,0.60048,3.14,0.0,0.0]

I have attached a picture of my calculation. I have used the transformation matrix for the rotation and translation (second point) relative to the first point. However, I dont get to the right result. 

Anyone having a clue what I am missing here?

@ur5eUser Please see the attached document and image. Hopefully, these help explain how I calculated the result. The results are more precise when using radians rather than degrees for theta. If you have any questions let me know!

Hallo I have a question. Your Solution had only show one situation with Rx=90 grad, right? But What should I do if Ry=5 Grad , Rz=48 Grad for Example? How should I calculate that? Thank you very much for your Help

Yiru

Please find the python code to create Pose_Add & Pose_Trans.
Code is in PDF format because I can't upload .PY

This program works for all angles, basically same as you define poses in URScript.

Main problem was, you need to convert rotation vector to Euler angles before creating rotation matrix.