Nonlinear Control of Manipulator Using Multibody Dynamics