4_竞赛无人机基本自动飞行支持函数与导航控制函数解析

根据前面几讲的介绍，要想实现无人机的自动飞行，单依靠姿态自稳、高度 控制远远不够，必须在水平位置—速度控制的基础上，才能保证无人机全程可控。 因此设计了一个基本自动飞行支持函数， 第一部分 OpticalFlow_Control_Pure()为 SLAM 定点控制，该函数在最后给定了 水平俯仰、横滚方向上的角度期望；第二部分 yaw_ctrl_mode=ROTATE， yaw_outer_control_output =RC_Data.rc_rpyt[RC_YAW]表示偏航控制为手动模式， 偏 航 控 制 期 望 来 源 于 遥 控 器 偏 航 杆 位 给 定 ； 第 三 部 分 Flight_Alt_Hold_Control(ALTHOLD_MANUAL_CTRL,NUL,NUL)为高度手动控制。 以上三部分共同保障了无人机自动飞行的基础，在 basic_auto_flight_support 运行的基础上，可以通过改变三维的位置期望来实现无人机三维位置控制，因此 专门设计了一个导航控制函数用于处理三维期望数据。