1. delete init_nav_quadcopter functions in Ground_Station
2. set the STARTUP_MODE of autopilot as AP_MODE_NAV