Add PivotJoint tests