Dynamics and Control of Multibody Systems