add 3d contact

Rohan Budhiraja requested to merge proyan/crocoddyl:topic/refact into topic/refact Jan 16, 2019