Added the 6d contact model + updated the bipedal example + benchmark for quadruped and biped
In this PR, I solved the following issues #230 (closed), #234 (closed) and #235 (closed). I have additionally solve a bug in the DDP solver (i.e. Vxx symmetric).