Feedback Dynamic Compensation via Multibody Models and Applications to Robot Control