Robot Dynamics: Equations and Algorithms