Fix PointMass calculate body Jacobian.