Arduino sketch for controlling an ESC