一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法与流程

本发明涉及一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法，使四旋翼飞行器系统有较好的动态响应过程。

背景技术：

四旋翼飞行器作为旋翼式飞行器的一种,以其体积小、机动性能好、设计简单、制造成本低廉等优点,吸引了国内外大学、研究机构、公司的广泛关注。然而，由于四旋翼飞行器体积小且重量轻，飞行中易受到外部干扰，如何实现对四旋翼飞行器的高性能运动控制已经成为一个热点问题。针对四旋翼飞行器的控制问题，存在很多控制方法，例如pid控制、自抗扰控制、滑模控制、反步控制等。

其中反步控制已经广泛应用于非线性系统，其优点包括响应速度快、实施方便、对系统不确定和外部干扰的鲁棒性等。传统的反步控制，只是考虑了四旋翼飞行器的稳态性能，并没有过多地关注其瞬态响应性能。因此，传统的反步控制方法使得四旋翼飞行器系统在实际情况中的应用有很大阻碍。为解决这一问题，基于障碍李雅普诺夫函数的反步控制方法被提出，这种方法在实际情况中能够有效地改善四旋翼飞行器系统的瞬态性能。

技术实现要素：

为了改善四旋翼飞行器系统瞬态性能，本发明提供了一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限步控制方法，减少了超调量和超调时间，使四旋翼飞行器系统具有一个良好的动态响应性能。

为了解决上述技术问题提出的技术方案如下：

一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法，包括以下步骤：

1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵t：

其中φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角，表示无人机依次绕惯性坐标系的各坐标轴旋转的角度；

1.2四旋翼飞行器平动过程中的动态模型如下：

其中x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置，uf表示四旋翼飞行器的输入力矩，m为四旋翼飞行器的质量，g表示重力加速度，

将式(1)代入式(2)得：

1.3四旋翼飞行器转动过程中的动态模型为：

其中τx,τy,τz分别代表机体坐标系上各个轴的力矩分量，ixx,iyy,izz分别表示机体坐标系下的各个轴的转动惯量的分量，×表示叉乘，ωp表示翻滚角速度，ωq表示俯仰角速度，ωr表示偏航角速度，表示翻滚角加速度，表示俯仰角加速度，表示偏航角加速度；

考虑到无人机处于低速飞行或者悬停状态，姿态角变化较小，认为因此式(4)改写为：

联立式(3)和式(5)，得到四旋翼飞行器的动力学模型为：

其中ux＝cosφsinθcosψ+sinφsinψ,uy＝cosφsinθsinψ-sinφcosψ；

1.4根据式(6)，定义φ,θ的期望值分别为：

其中φd为φ的期望信号值，θd为θ期望信号值，arcsin为反正弦函数；

步骤2，在每一个采样时刻，计算位置跟踪误差及其一阶导数；计算姿态角跟踪误差及其一阶导数；设计位置和姿态角控制器，过程如下：

2.1定义z跟踪误差及其一阶导数：

其中zd表示z的期望信号；

2.2定义q11：

2.3设计障碍李雅普诺夫函数v11：

其中ka1,kb1为正常数：

其中|e1|max为|e1|的最大值；

2.4求解式(10)一阶导数，得：

其中α1为虚拟控制量，其表达式为:

其中k11为正常数；

将式(13)代入式(12)，得：

2.5定义q12：

2.6设计障碍李雅普诺夫函数v12：

其中kd1,kc1为正常数：

其中|e1|max为|e1|的最大值；

求解式(16)一阶导数，得：

其中

将式(19)和式(6)代入式(18)，得：

2.7设计uf：

其中k12为正常数；

2.8定义x,y跟踪误差分别为e2,e3,则有：

其中xd,yd分别表示x,y的期望信号；

2.9定义q21,q31：

2.10设计障碍李雅普诺夫函数v21,v31：

其中ka2,kb2,ka3,kb3为正常数：

其中|e2|max为|e2|的最大值，|e3|max为|e3|的最大值；

2.11求解式(25)一阶导数，得：

其中α2,α3为虚拟控制量，其表达式为:

其中k21,k31为正常数；

将式(28)代入式(27)，得：

2.12定义q22,q32：

2.13设计李雅普诺夫函数v22,v32：

其中kc2,kd2,kc3,kd3为正常数：

其中|s2|max为|s2|的最大值，|s3|max为|s3|的最大值；

求解式(32)一阶导数，得：

其中

将式(35)和式(6)代入式(34)，得：

2.14设计ux,uy：

其中k22,k32为正常数；

2.15定义姿态角跟踪误差及其一阶导数：

其中j＝4,5,6，x4＝φ,x5＝θ,x6＝ψ，x4d表示φ的期望值，x5d表示θ的期望值，x6d表示ψ的期望值，e4表示φ的跟踪误差，e5表示θ的跟踪误差，e6表示ψ的跟踪误差；

2.16定义qj1：

2.17设计障碍李雅普诺夫函数vj1：

其中kaj,kbj为正常数：

其中|ej|max为|ej|的最大值；

2.18求解式(40)一阶导数，得：

其中αj为虚拟控制量，其表达式为:

其中kj1为正常数；

将式(43)代入式(42)，得：

2.19定义qj2：

2.20设计李雅普诺夫函数vj2：

求解式(46)一阶导数，得：

其中

将式(48)和式(6)代入式(47)，得：

2.21通过式(49)设计τx,τy,τz：

其中k42,k52,k62为正常数。

进一步，所述方法还包括以下步骤

步骤3，验证四旋翼飞行器系统的稳定性；

3.1将式(21)代入式(20)，得：

3.2将式(37)代入式(36)，得：

3.3将式(50)代入式(49)，得

3.4通过(51)，(52)，(53)可知四旋翼飞行器系统是稳定的。

本发明基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法，改善了系统的瞬态性能，减少了超调量和到达时间。

本发明的技术构思为：针对四旋翼飞行器的动力学系统，设计一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法。非对称时不变障碍李雅普诺夫函数的设计是为了保证系统的状态和输出能够限制在一定的范围内，避免过大的超调，同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。

本发明优点为：全状态受限，降低超调量，减少到达时间，改善瞬态性能。

附图说明

图1为本发明的位置跟踪效果示意图。

图2为本发明的姿态角跟踪效果示意图。

图3为本发明的位置速度跟踪效果示意图。

图4为本发明的姿态角速度跟踪效果示意图。

图5为本发明的位置控制器输入示意图。

图6为本发明的姿态角控制器输入示意图。

图7为本发明的控制流程示意图。

具体实施方式

下面结合附图对本发明做进一步说明。

参照图1-图7，一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法，包括以下步骤：

1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵t：

其中φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角，表示无人机依次绕惯性坐标系的各坐标轴旋转的角度；

1.2四旋翼飞行器平动过程中的动态模型如下：

其中x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置，uf表示四旋翼飞行器的输入力矩，m为四旋翼飞行器的质量，g表示重力加速度，

将式(1)代入式(2)得：

1.3四旋翼飞行器转动过程中的动态模型为：

其中τx,τy,τz分别代表机体坐标系上各个轴的力矩分量，ixx,iyy,izz分别表示机体坐标系下的各个轴的转动惯量的分量，×表示叉乘，ωp表示翻滚角速度，ωq表示俯仰角速度，ωr表示偏航角速度，表示翻滚角加速度，表示俯仰角加速度，表示偏航角加速度；

考虑到无人机一般处于低速飞行或者悬停状态，姿态角变化较小，认为因此式(4)改写为：

联立式(3)和式(5)，得到四旋翼飞行器的动力学模型为：

其中ux＝cosφsinθcosψ+sinφsinψ,uy＝cosφsinθsinψ-sinφcosψ；

1.4根据式(6)，定义φ,θ的期望值分别为：

其中φd为φ的期望信号值，θd为θ期望信号值，arcsin为反正弦函数；

步骤2，在每一个采样时刻，计算位置跟踪误差及其一阶导数；计算姿态角跟踪误差及其一阶导数；设计位置和姿态角控制器，过程如下：

2.1定义z跟踪误差及其一阶导数：

其中zd表示z的期望信号；

2.2定义q11：

2.3设计障碍李雅普诺夫函数v11：

其中ka1,kb1为正常数：

其中|e1|max为|e1|的最大值；

2.4求解式(10)一阶导数，得：

其中α1为虚拟控制量，其表达式为:

其中k11为正常数；

将式(13)代入式(12)，得：

2.5定义q12：

2.6设计障碍李雅普诺夫函数v12：

其中kd1,kc1为正常数：

其中|e1|max为|e1|的最大值；

求解式(16)一阶导数，得：

其中

将式(19)和式(6)代入式(18)，得：

2.7设计uf：

其中k12为正常数；

2.8定义x,y跟踪误差分别为e2,e3,则有：

其中xd,yd分别表示x,y的期望信号；

2.9定义q21,q31：

2.10设计障碍李雅普诺夫函数v21,v31：

其中ka2,kb2,ka3,kb3为正常数：

其中|e2|max为|e2|的最大值，|e3|max为|e3|的最大值；

2.11求解式(25)一阶导数，得：

其中α2,α3为虚拟控制量，其表达式为:

其中k22,k31为正常数；

将式(28)代入式(27)，得：

2.12定义q22,q32：

2.13设计李雅普诺夫函数v22,v32：

其中kc2,kd2,kc3,kd3为正常数：

其中|s2|max为|s2|的最大值，|s3|max为|s3|的最大值；

求解式(32)一阶导数，得：

其中

将式(35)和式(6)代入式(34)，得：

2.14设计ux,uy：

其中k22,k32为正常数；

2.15定义姿态角跟踪误差及其一阶导数：

其中j＝4,5,6，x4＝φ,x5＝θ,x6＝ψ，x4d表示φ的期望值，x5d表示θ的期望值，x6d表示ψ的期望值，e4表示φ的跟踪误差，e5表示θ的跟踪误差，e6表示ψ的跟踪误差；

2.16定义qj1：

2.17设计障碍李雅普诺夫函数vj1：

其中kaj,kbj为正常数：

其中|ej|max为|ej|的最大值；

2.18求解式(40)一阶导数，得：

其中αj为虚拟控制量，其表达式为:

其中kj1为正常数；

将式(43)代入式(42)，得：

2.19定义qj2：

2.20设计李雅普诺夫函数vj2：

求解式(46)一阶导数，得：

其中

将式(48)和式(6)代入式(47)，得：

2.21通过式(49)设计τx,τy,τz：

其中k42,k52,k62为正常数；

步骤3，验证四旋翼飞行器系统的稳定性；

3.1将式(21)代入式(20)，得：

3.2将式(37)代入式(36)，得：

3.3将式(50)代入式(49)，得

3.4通过(51)，(52)，(53)可知四旋翼飞行器系统是稳定的。

为了验证所提方法的可行性，本发明给出了该控制方法在matlab平台上的仿真结果：

参数给定如下：式(2)中m＝1.1kg，g＝9.81n/kg；式(4)中，ixx＝1.22kg·m²，iyy＝1.22kg·m²，izz＝2.2kg·m²；式(8),式(22)和式(38)中zd＝1，xd＝1，yd＝1，ψd＝0.5；式(13),式(29)和式(43)中k11＝0.083,k21＝0.083,k31＝0.083,k41＝1,k51＝1,k61＝1；式(21),式(37)和式(50)中k12＝1,k22＝1,k32＝1,k42＝1,k52＝1,k62＝1；式(10),式(26)和式(41)kb1＝kb2＝kb3＝kb4＝kb5＝kb6＝2.8,ka1＝ka2＝ka3＝ka4＝ka5＝ka6＝3；式(17),式(33)和式(45)kd1＝kd2＝kd3＝kd4＝kd5＝kd6＝2.8,kc1＝kc2＝kc3＝kc4＝kc5＝kc6＝3；

从图1和2可知，系统输出具有良好的瞬态特性，到达时间为6.543秒，超调量为0。

从图3和4可知，系统状态具有良好的瞬态特性，到达时间为5.544秒，超调量为0。

综上所述，基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法能有效地改善四旋翼飞行器系统全状态的瞬态性能。

以上阐述的是本发明给出的一个实施例表现出的优良优化效果，显然本发明不只是限于上述实施例，在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。