Jmeyer1292 / opw_kinematics

Closed form IK for parallel base, spherical wrist industrial manipulators
Apache License 2.0
72 stars 26 forks source link

Direction of b in the sketch #58

Open simonschmeisser opened 3 years ago

simonschmeisser commented 3 years ago

We just had some great confusion party and smoking heads while trying to parametrize a Doosan robot due to the arrow in that graphics for b pointing in the wrong direction (?)

Here is an example back side view of a Stäubli TX2 90L robot: image

The parameters for the Stäubli that work perfectly fine and are consistent in the self-tests are

opw_kinematics_geometric_parameters:
    a1:  0.05
    a2:  0.0
    b:   0.050
    c1:  0.478
    c2:  0.500
    c3:  0.550
    c4:  0.100
opw_kinematics_joint_offsets: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
opw_kinematics_joint_sign_corrections: [1, 1, 1, 1, 1, 1]

as I also committed here ( https://github.com/ros-industrial/staubli_experimental/blob/kinetic-devel/staubli_tx2_90_support/config/opw_parameters_tx2_90l.yaml )

Comparing it with the sketch, b should be negative however.

@axelschroth

Levi-Armstrong commented 3 years ago

Is the sign correct if you were using the y0 at the bottom as the positive direction?

simonschmeisser commented 3 years ago

yes, then it would be correct but the sketch would look strange image

Actually I find it quite strange already, maybe it should be replaced by two more realistic ones (one with b, Stäubli and Doosan, one without b for brands like ABB, Fanuc, Kuka, ...)