test 02 17 : PD controller for the torso CoM.