Clean up BallJoint and FreeJoint
Add a test for Issue 122