Fundamentals of Multibody Dynamics