update the contact forces (in the world frame)
add message for improvments
add some comments and start implementation of normals
after reset head, redo out_of_friction, but lost work on normal which does not work
normal and tangent in phi and dphi included in the calculus
temporary normal tested
normal vector included in calculus
take into account the normal for contact force computation
fix bug at compilation