Change output signal of hrp2-device-pos-ctrl from encoders (n dimensional) to robotState (n+6 dimensional) for coherence with the real robot device. Change accordingly the input signal of the force-torque-estimator. Add transformation of IMU measurements to torso's frame.