robotic toolbox by Paolo Di Prodi

A toolbox for industrial robot manipulator (kinematics robotis in..., mechanical modeling)

T=staticForce(J6,F)

Tmat=Tcyl(alfa,l,r)

Tmat=Tsfer(gamma,beta,r)