Modification of dune_sway_control in sway-motion-correction.py
Delete some error in sway_motion_correction.py
debug pb lateral velocity
delete debug lines
Add twist matrix cd->c
Correction of ComVel (add world to waist Twsit matrix)
Modification of speed limitation
Merge branch 'remote/cd-ctrl-law' into topic/cd-ctrl-law