在APM飞控系统中，采用的是两级PID控制方式，第一级是导航级，第二级是控制级，导航级的计算集中在medium_loop()和fastloop()的update_current_flight_mode()函数中，控制级集中在fastloop()的stabilize()函数中