This PR contains two updates:
[CopTask]
-The reference CoP apply a torque w.r.t the target CoP using the measured vertical force instead of the desired one. An option is now available to switch between using desired or measure vertical force.
-The StabilizerTask now uses the desired vertical force to compute the desired torque
[StabilizerTask WrenchDistribution]
-The force distribution on an horizon is now updated at the sampling rate of the given references
This PR contains two updates: [CopTask] -The reference CoP apply a torque w.r.t the target CoP using the measured vertical force instead of the desired one. An option is now available to switch between using desired or measure vertical force. -The StabilizerTask now uses the desired vertical force to compute the desired torque
[StabilizerTask WrenchDistribution] -The force distribution on an horizon is now updated at the sampling rate of the given references