Slide 29
Slide 29 text
Forward Kinematics with vektor
var vektor = require('vektor'),
Homog = vektor.homog,
Vector = vektor.vector,
Rotate = vektor.rotate,
H0, H1, H2, H3, endEff;
H0 = Homog(Rotate.RotX(0), new Vector([0, 0, 0]));
H1 = H0.dot( Homog(Rotate.RotZ(angles[0]), 0) );
H2 = H1.dot( Homog(Rotate.RotZ(angles[1]), new
Vector([100,0,0])) );
H3 = H2.dot( Homog(0, new Vector([100,0,0])) );
endEff = T3.getPoint();