Rigid Body Dynamics Algorithms - Featherstone (Springer US, 2008)