multibody inverse dynamics