dehaeze21_mechatronics_appr.../paper/figs/nass_simscape_3d.pdf