1. sync the state machine of quad_swarm and the GCS
2. add #include "autopilot.h" in quad_swarm.c for detection of autopilot_mode
3. add #include "subsystems/navigation/common_flight_plan.h" for nav_block