Dynamics shaping for the control of instrumental robots