Moved the common ESC routines
Removed unused constant
Removed centering correction which prevents trimming the sticks
Added PID and IMU logs