Update flightControl.c