Describir: Gravity compensation and optimal control of actuated multibody system dynamics