Updated code with quad controller, gps_threaded and led directions code