Envoyer par SMS: Gravity compensation and optimal control of actuated multibody system dynamics