Added CONTINUOUS joint and fixed addShape to store mass and inertia info