pivots were wrong signed, everything was upside down
Merge pull request #621 from georgiee/fix-p2-revolute-joint

p2 revolute pivots were wrong signed