Add Lengthening leg

Improved normal movement
Added CenterOnStop for prismatic Joints
Added (not working) lengthening leg.