[main_prop] Adds untested backlash compensation code
Merge branch 'dev_coupe' of https://github.com/ENAC-Robotique/Robots into dev_coupe