Robot Dynamics Algorithms door Roy Featherstone