First walking version. Still have a segfault at desallocation, and a random crash (abord for negative Kp gain ...).

Previous commit is not properly taged: first version, working only for the COM task. Alternance has now to be set to release contact for each step.