Multibody System Dynamics, Robotics and Control