Fix indexing Dof in Skeleton.
Fix contact Jacobian.