implemented UF controller (sum of torque)
UF to debug
updating rcvtoolbox