Dynamics Shaping for the Control of Instrumental Robots