- Get the hardware initialize into the state machine (remove from main.c) | If error go to error - Controlled Flight (Reading from UART and acting on that) - Hover (Stabilized from PID)