Home Programming

Discussion

Left ArrowBack to discussions page
DieterDieter Unconfirmed Posts: 7 Apprentice
Hello,


I am using a UR3e and some UR_script functions. My program is supposed to drive to three positions of a Surface, calculate the normalvector (nx, ny, nz) and then calculating the rotation around x and y of normal Vector:
- Rx is calculated by Rx= -arctan(ny/nz)  
- Ry is calculated by Ry=arctan(nx/nz)
Now i want to drive to a pose "p1" relative to the calculated rotation of the global coordinate System rot_cs = p[0,0,0,Rx,Rx,0]. So I am calculating the new pose by using pose_trans(rot_cs, p1). But it's not working. I cannot find the mistake. What am I missing when I want to do the Transformation?


Thank you


Dieter

Comments

  • jelmsjelms Posts: 27 Handy
    You math from normal to axis-angle format is not correct. For a normal that is in the x,y direction (0.707,0.707,0) the formulas (using atan2) give Rx = -1.57 and Ry = 1.57. The axis-angle should be Rx=-1.11, Ry = 1.11.

    I think this will help. It wasn't completely clear you goal, but this shows how to take a normal vector `n` and generate a pose transformation that should takes the unit z vector to the normal vector.
    def main():
    
        nv = p[0, 0, 0, -1.57/sqrt(2), 1.57/sqrt(2), 0]
        eig = p[0, 0, 1, 0, 0, 0]
        textmsg("a1: ", pose_trans(nv, eig))
    
    
        n = [0.0, 0.707, 0.707]
        nn = sqrt(n[0] * n[0] + n[1] * n[1])
        r = atan2(nn, n[2])
        textmsg("r: ", r)
        nv = p[0, 0, 0, -r * n[1]/nn, r * n[0]/nn, 0]
        eig = p[0, 0, 1, 0, 0, 0]
        textmsg("a2: ", pose_trans(nv, eig))
    
    end
    


Sign In or Register to comment.
Left ArrowBack to discussions page