Added c++ implementation and Python bindings of multiple contact iface + fixed few bugs
In this PR I solved the issue #217 (closed). Additionally it solved the old problem with Pinocchio v2.1.5 compilation (#200 (closed)). By doing so, I noticed other issues in the test_contact unit-test where I detected and solved a bug in the contact 3d model.