Set up of the control graph

Preliminary implementation work: implement a COM tracking in simu and on the robot. Just to test the OS.

All issues for this milestone are closed. You may close this milestone now.