Advanced Robot Dynamics and Control