Reference

Rigid Body Dynamics Algorithms, Roy Featherstone. (2008)