Contacts - 6D Loop contacts

[LudovicDeMatteis]

This PR adds a new type of contact to Crocoddyl. We defined loop contacts (i.e. between parts of the robot) with 6D constraints (constraint on the contact frames relative position and orientation)