Big commit after the IROS rush.
All the functionnalities presented in the "Point-cloud multi-contact planning for Humanoids: Preliminary results" paper are here.