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