Based on http://www.petercorke.com/Robotics_Toolbox.html

I've been working through getting a kinematic model for the InMoov, recently, I stumbled across a python library based on the matlab robotics toolkit.  It uses NumPy for much of the heavy lifting math operations.  

So far I've been able to create a very small script to compute forward kinematcis of a set of links using this python robotics toolkit

The blow example is actually from the Puma560 arm DH parameters, but it shows the 4x4 transformation matrix for forward kinematic computation when all the joint angles are set to zero.    I hope to have a much less contrived example soon. (the second matrix is the angles of the arm up)  Joint angles are shown in radians.

 

name: InMoov
manufacturer: InMoov Nation
commment: params of 12/14/2014
Link 1------------------------
alpha = 1.570796        A = 0.000000    theta = 0.000000        D=0.000000      jtype: R        conv: (std)
Link 2------------------------
alpha = 0.000000        A = 0.431800    theta = 0.000000        D=0.000000      jtype: R        conv: (std)
Link 3------------------------
alpha = -1.570796       A = 0.020300    theta = 0.000000        D=0.150050      jtype: R        conv: (std)
Link 4------------------------
alpha = 1.570796        A = 0.000000    theta = 0.000000        D=0.431800      jtype: R        conv: (std)
Link 5------------------------
alpha = -1.570796       A = 0.000000    theta = 0.000000        D=0.000000      jtype: R        conv: (std)
Link 6------------------------
alpha = 0.000000        A = 0.000000    theta = 0.000000        D=0.000000      jtype: R        conv: (std)


Q = [0, 0, 0, 0, 0, 0]
[[ 1.       0.       0.       0.4521 ]
 [ 0.       1.       0.      -0.15005]
 [ 0.       0.       1.       0.4318 ]
 [ 0.       0.       0.       1.     ]]
Q = [0, 1.5707963267948966, -1.5707963267948966, 0, 0, 0]
[[  1.00000000e+00   1.50343015e-49  -3.21207594e-82   2.03000000e-02]
 [  1.50343015e-49   1.00000000e+00   0.00000000e+00  -1.50050000e-01]
 [  0.00000000e+00   0.00000000e+00   1.00000000e+00   8.63600000e-01]
 [  0.00000000e+00   0.00000000e+00   0.00000000e+00   1.00000000e+00]]
 
 
 

GroG

9 years 4 months ago

WOOHOO! .. so the resultant matrix are the DH parameters?

for other FK computations?

or one is the DH parameters & the other is the result @ 0 radians (all joints) ?