Rigid body tree dynamics method returned invalid (NaN or Inf) results. Please check the inertial parameters of the rigidBodyTree object. For example, a leaf non-fixed body that has zero mass can cause forwardDynamics to return NaN.


rigidbodytree