一种复合翼无人机的自抗扰控制器及其建立方法
文献发布时间:2023-06-19 11:45:49
技术领域
本发明属于无人机技术领域,具体涉及一种复合翼无人机的自抗扰控制器及其建立方法。
背景技术
无人飞行器(Unmanned aerial vehicle,UAV)简称无人机,是指利用无线电设备进行遥控或计算机程序自主控制的不载人飞行器,具有使用简单,安全性高,成本低廉的特点。早期无人机种类单一,飞行高度低,续航能力差,应用场景有限。伴随着微处理器、微型电机、新型能源、新型复合材料等快速发展,无人机变得种类繁多,飞行高度和续航能力大幅度提升。
由于不同应用场景(作业高度、作业距离、作业时间、任务种类等)对无人机有着不同的需求,诞生出了多种类型的无人飞行器,固定翼与旋翼组成复合式结构无人飞行器,称作复合翼无人机,是一种垂直起降固定翼无人机。这种无人机兼顾了旋翼和固定翼的优势,广泛应用于复杂场景测绘、救灾救援、农业植保、物流配送等方面,具有重要的研究意义和应用价值。复合翼无人机的控制涉及两个模式的切换,目前市面上大多数复合翼无人机在旋翼系统和固定翼系统之间过渡切换过程中存在控制不稳定性现象,经常出现切换过程中无人机高度突然下降或者高度控制不稳定的现象,特别在过渡模式下,当复合翼无人机收到干扰后,飞行高度极其容易出现较大波动甚至坠机,使用自抗扰控制器后,具有一定改善,但仍有不少问题。因此如何将复合翼无人机的两个系统融合并实现稳定飞行,具有极大的挑战性。
发明内容
有鉴于此,本发明提供了一种复合翼无人机的自抗扰控制器及其建立方法,在基于自抗扰控制的复合翼无人机控制方式中加入了过渡过程,增加了控制的稳定性。
为实现上述目的,本发明的一种复合翼无人机的自抗扰控制器,包括跟踪微分器、扩张状态观测器以及系统控制律;
其中,跟踪微分器用于给输入信号安排过渡过程和提取微分;扩张状态观测器用于用来实时估计系统的扰动并实时给予补偿;系统控制律用于提高系统动态性能;
其中,通过非线性权重分配提高过渡平稳性,具体如下:
其中,α是固定翼系统权重,V是无人机空速,V
其中,所述跟踪微分器形式如下所示:
fh=fhan(v
v
v
其中v(k)代表输入离散信号,fhan为最速综合函数,v
最速综合函数fhan(x
d=rh
y=x
a
s
a=(a
s
fhan=-r(a/d-sign(a))s
其中,r是控制量增益,h是精度因子,x
其中,所述扩张状态观测器为:
e=z
其中,z
其中,所述系统控制律为:
其中b
u
其中b
误差e
e
e
其中,z
本发明还提供了一种复合翼无人机的自抗扰控制器的建立方法,包括如下步骤:
步骤一:建立复合翼无人机四旋翼模式、固定翼模式以及过渡模式机体坐标受力与力矩;
步骤二:根据步骤一中建立的模型,将自抗扰控制器用于过渡模式四旋翼系统,设计基于自抗扰控制技术的姿态控制中的跟踪微分器,该跟踪微分器形式如下所示:
fh=fhan(v
v
v
其中,v(k)代表输入离散信号,k代表离散时刻中的k时刻,fhan为最速综合函数,v
d=rh
y=x
a
s
a=(a
s
fhan=-r(a/d-sign(a))s
步骤三:设计如下三阶扩张状态观测器(ESO),用来实时估计系统的扰动并实时给予补偿:
e=z
其中,z
步骤四:根据观测器得到的系统状态z
e
e
设计的非线性控制率如下:
u
其中b
步骤五:设计出非线性反馈律后,根据自抗扰控制原理得到系统控制律为:
其中b
步骤六:提出非线性权重分配提高过渡平稳性:
其中,α是固定翼系统权重,V是无人机空速,V
其中,所述四旋翼模式受力与力矩如下:
其中i表示第i个电机,ω
其中,所述固定翼模式受力与力矩如下:
其中b、
其中,所述过渡模式受力与力矩如下:
其中,复合翼无人机动力学方程与运动学方程如下:
其中(·)表示三种飞行模式:四旋翼模式q,固定翼模式p,过渡模式f,φ、θ、ψ分别表示滚转、俯仰和偏航姿态角。
有益效果:
本发明在基于自抗扰控制的复合翼无人机控制方式中加入了过渡过程,增加了控制的稳定性,自抗扰控制器具有精度高、抗扰能力强的优点,避免了复合翼无人机在飞行过程中涉及模式切换过程中出现高度控制不稳定的现象,将复合翼无人机的两个系统融合并实现稳定飞行。
附图说明
图1为本发明仿真实例中传统PID控制器与本发明自抗扰控制器的空速变化示意图;
图2为本发明仿真实例中传统PID控制器与本发明自抗扰控制器的权重分配关系图;
图3(a)为本发明仿真实例中过渡模式下使用传统PID控制器的高度变化示意图;
图3(b)为本发明仿真实例中过渡模式下使用自抗扰控制器的高度控制效果示意图;
图4(a)为本发明仿真实例中使用PID控制器的扩张状态观测器对扰动观测结果示意图;
图4(b)为本发明仿真实例中使用自抗扰控制器的扩张状态观测器对扰动观测结果示意图;
图5为本发明仿真实例中复合翼无人机整个飞行过程中的位置变化示意图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
复合翼无人机在飞行过程中涉及多个模式的切换,且切换过程中容易出现高度控制不稳定的现象,因此采用具有抗扰能力高度控制器是非常必要的。传统PID控制器采取给定与输出量反馈之差作为控制信号,用误差消除误差,自抗扰控制器是由PID控制器演变而来,与现代控制理论相结合,采用“观测+补偿”的方法。自抗扰控制器中的非线性扩张状态观测器存在着参数调节困难的问题,高志强教授提出了线性扩张状态观测器,并给出了带宽法的调参方法。
本发明将自抗扰控制器用于旋翼系统的高度控制,用F
本发明的一种复合翼无人机的自抗扰控制器,包括跟踪微分器、扩张状态观测器以及系统控制律;
其中,跟踪微分器用于给输入信号安排过渡过程和提取微分;扩张状态观测器用于用来实时估计系统的扰动并实时给予补偿;系统控制律用于提高系统动态性能;
其中,通过非线性权重分配提高过渡平稳性,具体如下:
其中,α是固定翼系统权重,V是无人机空速,V
具体地,所述跟踪微分器形式如下所示:
fh=fhan(v
v
v
其中v(k)代表输入离散信号,fhan为最速综合函数,v
最速综合函数fhan(x
d=rh
y=x
a
s
a=(a
s
fhan=-r(a/d-sign(a))s
其中,r是控制量增益,h是精度因子,x
具体地,所述扩张状态观测器为:
e=z
其中,z
具体地,所述系统控制律为:
其中b
u
其中b
误差e
e
e
其中,z
本发明还提供了对四旋翼模式高度通道的自抗扰控制器的建立方法,包括如下步骤:
步骤一:建立复合翼无人机四旋翼模式、固定翼模式以及过渡模式机体坐标受力与力矩;
其中,四旋翼模式受力与力矩如下:
其中i表示第i个电机,ω
固定翼模式受力与力矩如下:
其中b、
过渡模式受力与力矩如下:
复合翼无人机动力学方程与运动学方程如下:
其中(·)表示三种飞行模式:四旋翼模式q,固定翼模式p,过渡模式f,φ、θ、ψ分别表示滚转、俯仰和偏航姿态角。
步骤二:根据步骤一中建立的模型,将自抗扰控制器用于过渡模式四旋翼系统,设计基于自抗扰控制技术的姿态控制中的跟踪微分器,该跟踪微分器形式如下所示:
fh=fhan(v
v
v
其中v(k)代表输入离散信号,其中,k代表离散时刻中的k时刻,fhan为最速综合函数,v
最速综合函数fhan(x
d=rh
y=x
a
s
a=(a
s
fhan=-r(a/d-sign(a))s
其中,r是控制量增益,h是精度因子,x
步骤三:设计如下三阶扩张状态观测器(ESO),用来实时估计系统的扰动并实时给予补偿:
e=z
其中,z
步骤四:根据观测器得到的系统状态z
e
e
设计的非线性控制率如下:
u
其中b
步骤五:设计出非线性反馈律后,根据自抗扰控制原理得到系统控制律为:
其中b
步骤六:通过非线性权重分配提高过渡平稳性,具体如下:
其中,α是固定翼系统权重,V是无人机空速,V
以旋翼模式向固定翼模式切换的过渡过程为例,对PID控制器与自抗扰控制器在复合翼无人机过渡模式的高度控制进行仿真对比如下:
为了便于对比过渡模式下自抗扰控制器与PID控制器的控制效果,过渡过程中均采用基于模型的非线性权重分配方法,对高度通道输入从10s到25s间对应高度从0m增长为20m的斜坡信号,并在高度控制中增加均值为0,方差为0.001的测量噪声和方差为0.001的过程噪声。为了让两种控制方式的过渡模式同步进行,空速通道的输入从50s到65s间对应的空速从0m/s增长为17m/s的斜坡信号,设置过渡模式的最小转换空速Vmin=10m/s,最大转换空速Vmax=15m/s,仿真结果如下:
图1显示两种控制器的空速变化,0s到50s处于四旋翼模式。50s到64s进入过渡模式,期间固定翼推力电机开始让飞机的空速快速增加,64s时空速达到16m/s。64s以后进入固定翼模式,65s后复合翼无人机开始以17m/s的空速平飞。图2显示两种控制器的权重分配关系,两种控制器均采用基于模型的非线性权重分配方法,从50s到64s为过渡模式,其中50s到58s之间由于V 图3(a)显示了过渡模式下使用PID控制器的高度变化,在10s到25s的垂直起飞过程中有0.5m的超调,从50s到64s的过渡过程中高度变化较大,且在第62s时的最大的高度波动为0.5m。图3(b)为自抗扰控制器高度控制效果示意图,在10s到25s的垂直起飞过程中没有出现超调,可以很好跟踪斜坡输入信号,从50s到64s的过渡过程中高度几乎没有发生变化,在第62s时的最大的高度变化仅有0.04m。自抗扰控制器可以很好提高过渡模式下高度控制的稳定性。 图4(a)为使用PID控制器的扩张状态观测器对扰动观测结果,图4(b)为使用自抗扰控制器的扩张状态观测器对扰动观测结果。在0s到50s的四旋翼模式下,扩张状态观测器观测出旋翼系统受到9.8m/s2竖直向下的重力加速度。从50s到64s为过渡模式,其中50s到58s之间由于V 综上所述,以上仅为本发明的较佳实施实例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
- 一种复合翼无人机的自抗扰控制器及其建立方法
- 一种降阶自抗扰控制器及其建立方法