Fixed Jacobian bug for articulated bodies