Constraint mapping in a feedback linearization/MPC scheme for trajectory tracking of underactuated multibody systems. Issue 23 (2015)