横向/纵向自动驾驶仪设计过程

        用连续闭环设计小型无人机的横向和纵向自动驾驶仪。

        横向驾驶仪包括作为内环的俯仰姿态控制和作为外环的航迹角控制。下图用连续闭环显示了一个横向自动驾驶仪的框图。与横向驾驶仪相关的增益有5个。(滚转)微分增益提供了最内环的滚转率阻尼。滚转姿态由(滚转)比例增益和(滚转)积分增益调整。航线角由(航线角)比例增益和(航线角)积分增益调整。用到连续闭环的主要原因是：增益首先在最内环开始选择,然后再逐渐向外选取。特别地,首先选择(俯仰)微分增益和(俯仰)比例增益，其次是(滚转)积分增益，最后是(航线角)比例增益和(航线角)积分增益。

利用连续闭环的横向控制自动驾驶仪

        纵向自动驾驶仪更加复杂,同时依赖于飞行高度。在每个区域都用俯仰-姿态控制环作为内环。在起飞区域,MAV 油门最大,同时调整 MAV 保持一个固定的起飞俯仰角。在上升区域,MAV油门最大,空速由俯仰-空速控制自动驾驶仪调整。下降区域和上升区域类似(除了MAV的油门最小)。在高度控制区域,高度由高度-俯仰自动驾驶仪来调整,而空速由油门-空速自动驾驶仪环控制。

纵向自动驾驶仪的飞行状态

横向自动驾驶仪设计过程

1 输入：传递函数系数和，标准空速和副翼极限。

2 调整参数：滚转角极限，阻尼系数和，滚转积分增益，带宽隔离，其中。

3 计算自然频率：用式(6.8)计算内环的自然频率，外环的自然频率为。

        滚转回路的自然频率：

4 计算增益：用式(6.7)、式(6.9)、式(6.12)和式(6.13)计算增益，，和。

纵向自动驾驶仪设计过程

1 输入：传递函数系数,,,和，标准空速和升降翼极限。

2 调整参数：俯仰角极限，阻尼系数，，和；自然频率，高度环的带宽隔离为,空速俯仰环的带宽隔离为。

3 计算自然频率：用式(6.19)计算俯仰环的自然频率，用计算高度环的自然频率，用计算利用俯仰环空速的自然频率。

        俯仰环的自然频率：

4 计算增益：用式(6.20)和式(6.22)计算增益和，用式(6.23)计算俯仰环的DC增益；用式(6.25)和式(6.24)计算增益和；用式(6.28)和式(6.27)计算增益和；用式(6.30)和式(6.29)计算增益和。

        俯仰比例增益、俯仰微分增益：

         俯仰环的DC增益（俯仰环的带宽极限）:

          增益和：

          增益和：

          增益和：

          用连续闭环来设计小型无人机的横向和纵向自动驾驶仪。横向驾驶仪包括作为内环的俯仰姿态控制和作为外环的航迹角控制。纵向自动驾驶仪更加复杂,同时依赖于飞行高度。在每个区域都用俯仰-姿态控制环作为内环。

————————END————————