Featherstone articulated rigid body dynamics.
Implements:
- Forward kinematics
- Articulated Body Algorithm (ABA) for forward dynamics
- Recursive Newton-Euler Algorithm (RNEA) for inverse dynamics
- Composite Rigid Body Algorithm (CRBA) for mass matrix
- Semi-implicit Euler integration