Use the featherstone formulation for Planar joint.
Add planar joint in euler integration.