Rigid Body Dynamics Algorithms by Roy Featherstone