Sloppy autopilot program for Arduino, written in C