Remove CoMCollisionConstr that is unstable. Use CoMIncPlaneConstr instead.
Port CoMIncPlaneConstr to the new API.