Forward and inverse kinematics solvers.
Peter Corke's toolbox for kinematics, dynamics and trajectories.