根据前面几讲的介绍,要想实现无人机的自动飞行,单依靠姿态自稳、高度
控制远远不够,必须在水平位置—速度控制的基础上,才能保证无人机全程可控。
因此设计了一个基本自动飞行支持函数,
第一部分 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
运行的基础上,可以通过改变三维的位置期望来实现无人机三维位置控制,因此
专门设计了一个导航控制函数用于处理三维期望数据。
2022-04-18 09:05:41
817KB
开源
飞控
SDK
1