Bug fixes:
-Corrected initialization of ESCs

Improvements:
-Simplified PID usage by transforming "update" into a function
-Offset for throttle value (+ 110)
-Use of Table of PID clases