Kuka iiwa r800 : Calibrating a base in the workbench with 3 point

  • Hello,
    i'm actually working on a Kuka iiwa r800, i want to calibrating a base with 3 point, i want to do it directly in the script, not in the SmartPad. Is there any function that already exist ?
    Thanks

  • Place your Ad here!
  • It seems that there is no such api in sunrise api. So I wrote something like the following as the base generator for our project.

  • Thanks for answer me.
    I understand what you mean until this moment :


    double rotAngle = startZ.angleRad(direction);


    Vector rotAxis = null;
    if (rotAngle == 0.0 :tired_face: rotAngle == Math.PI)
    {
    rotAxis = Vector.of(1.0, 0.0, 0.0);
    }
    else
    {
    rotAxis = startZ.crossProduct(direction);
    }


    return new Frame(a, Transformation.of(Vector.of(0.0, 0.0, 0.0), AxisAngleRotation.of(rotAxis, rotAngle)));


    I don't understand what are RotAngle and RotAxis, and i don't understand the return frame, can you explain more please ?
    Sorry for my bad English.

  • The whole process is
    (1)get the vector ab and ac, where frame a as the reference coordinate system.
    (2)check whether ab and ac are on the same line. If so, throw exception.
    (3)ab cross ac is the normal direction of new base, where frame a as the reference coordinate system.
    (4)calculate the angle from reference coordinate system's z vector(0,0,1) to the new base's normal direction by the right hand law.
    I)if the z vector and the normal direction is on the same line(angle is 0 or Pie), choose any vector except z as the pivot to rotate around.
    II) else choose the real pivot vector to rotate around. The pivot vector is the cross of the two vectors.
    (5) value Transformation.of(Vector.of(0.0, 0.0, 0.0), AxisAngleRotation.of(rotAxis, rotAngle)) is the Transformation from frame a to the new base.
    (6) So the final base frame should combine the reference frame a and the transformation together.
    Welcome to any questions and suggestions.

  • Hello,


    I try the function on the Robot, but I Have a little Problem :


    At the end, I get a result like this :


    [ 0, 0, 0, 1.30, 0.5, 3.14 ]


    There is no transformation of translation, I don't even know how to do it, Do you know the mathematical formula to calibrating a base ?


    Thanks

  • I suspect that you have only printed the Transformation of the base frame relative to his parent(frame a).
    You can get its transformation relative to World by method baseFrame.transformationFromWorld().
    Also you can get the formula by the combination of cross multiplying and dot multiplying.
    Maybe you can provide more details about your 3 frames/points so that I can have a verification.

  • Hi,


    Yes effectively, i don't do any transformation, i'll try TransformationFromWorld later, (For the moment i'm working at distance from my robot, it's not that easy), so the 3 Frame a,b and c :


    a= [532.5, 1, -160.7, -60.7, 0.2, -0.002, 3.1]


    b= [532.5, 1, -331.9, -60.7, 0.2, -0.002, 3.1]


    c= [637.7, 1, -160.6, -60.3, 0.2, -0.002, 3.1]


    And my base must be : [ 532.5, -160.7,-60.7, -1.6 rad, -0.001 rad, 0.004 rad]


    This is the base i get with the SmartPad function.


    Thanks.

  • Both bases are OK.
    Firstly the x/y/z in the world are the same for the taught base and the calculated base.
    Secondly the transformation between the two bases is [X=0.00 Y=0.00 Z=0.00 A=1.72 B=0.00 C=0.00] which means they have the same Z direction.


    If you want to specify the x,y direction of you base, you need to specify more(like x goes along ab direction) because the right hand law only can decide Z direction

    Code
    Frame a = new Frame(532.5, -160.7, -60.7, 0.2, -0.002, 3.1);
            Frame b = new Frame(532.5, -331.9, -60.7, 0.2, -0.002, 3.1);
            Frame c = new Frame(637.7, -160.6, -60.3, 0.2, -0.002, 3.1);
            Frame taughtBase = new Frame(532.5, -160.7, -60.7, -1.6, -0.001, 0.004);
            Frame calcBase = generateBaseFrame(a, b, c);
            System.out.println("calc          base:" + calcBase.toStringInWorld());
            System.out.println("base transform:" + taughtBase.staticTransformationTo(calcBase));
            //calc          base:[X=532.50 Y=-160.70 Z=-60.70 A=0.12 B=-0.00 C=-0.00]
            //base transform:[X=0.00 Y=0.00 Z=0.00 A=1.72 B=0.00 C=0.00]
  • If you want to specify the x,y direction of you base, you need to specify more(like x goes along ab direction) because the right hand law only can decide Z direction


    So for exemple, if i want the right angle between the new and the former base, i think i'll use the trigonometry ( Tangent ?) or is there a better option ?(see attached picture).
    Thanks.

  • I've made some adjustment of the base frame generating function, which makes a as original point, x axis along with ab, under right hand law.
    Also I made the calculated base frame child of world directly instead of child of frame a.

Create an account or sign in to comment

You need to be a member in order to leave a comment

Create an account
Sign up for a new account in our community. It's easy!
Register a new account
Sign in
Already have an account? Sign in here.
Sign in Now

Advertising from our partners