Use ipopt-sparse.
Fix self collisions jacobian miss computation.
Add planar joint support.
Don't add planar position/orientation constraint if the planar contact is the root body and his parent is a Planar joint.
But we still add the planar inclusion constraint.
Don't add fixed orientation/position constraint if the body is the root body and his parent is a fixed joint.