Robot and Multibody Dynamics