New Proportional/Integral motor control and my personal compass routines
Merge https://github.com/jmontant/proBot