Removed old firmware and put in the start of the new firmware.
Cleaned up code and started organizing it for production.
Added class to handle RGB LED.
Added motor implementation.
Duh, we're doing power control, we should just reboot the ESC when we want to arm it.