CN107368088A - 一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法 - Google Patents
一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法 Download PDFInfo
- Publication number
- CN107368088A CN107368088A CN201710558755.7A CN201710558755A CN107368088A CN 107368088 A CN107368088 A CN 107368088A CN 201710558755 A CN201710558755 A CN 201710558755A CN 107368088 A CN107368088 A CN 107368088A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mtd
- mtr
- mover
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000013461 design Methods 0.000 claims abstract description 20
- 238000009415 formwork Methods 0.000 claims abstract description 9
- 230000006870 function Effects 0.000 claims description 28
- 230000008569 process Effects 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 7
- 238000009795 derivation Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000002153 concerted effect Effects 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 abstract description 2
- 238000011160 research Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000001360 synchronised effect Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 230000009897 systematic effect Effects 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 2
- 238000007667 floating Methods 0.000 description 2
- 230000009187 flying Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000035800 maturation Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- External Artificial Organs (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，针对含有动态执行机构的四旋翼无人机系统，利用非线性滑模控制方法，设计一种四旋翼无人机系统非线性滑模位姿控制方法。滑模面的设计是为了保证系统的快速稳定收敛。另外，采用非线性函数设计滑模面可以提高系统的鲁棒性以及跟踪精度。本发明提供一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，实现系统的快速稳定控制。
Description
技术领域
本发明涉及一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，以满足四旋翼无人机对参考输入快速准确跟踪的性能要求。
背景技术
无人机(Unmanned Aerial Vehicle,UAV)是通过远程遥控或基于无人机自身传感器实现自主飞行的飞行器。随着其技术的不断成熟,已被应用于民用、军用的很多领域。无人机可以分为固定翼和旋翼两种,固定翼无人机的优点是能量效率高，因此飞行距离和时间都较长，小型滑翔机在风速不大时也比较容易控制，但是它们被设计为无人形式时，操作性较差。相比而言，旋翼无人机则具有很强的可操作性，且机动性强，能够很方便地完成起飞与降落等动作，对工作环境的要求也比较低。四旋翼无人机作为旋翼式无人机的一种,以其体积小、机动性能好、设计简单、制造成本低廉等优点,吸引了国内外大学、研究机构、公司的广泛关注。旋翼无人机非常适合用于监视、侦察等民用和军用领域。在民用领域,旋翼无人机主要被应用于抗灾救险、地面监测、高空航拍等；由于其隐蔽性髙,可靠性好,也被用于战场监控、军事侦察等军用领域。在国外无人机研究也是一大热点，其中美国航空航天局(NASA)已经研制出了十旋翼的无人驾驶飞机用于战略探测及科学研究，还开发出了可使大型无人机与有人驾驶航空器一同在国家空域内安全飞行的技术；在国内无人机研究也受到高度重视，在“十三五”规划的第五部分高端装备，第18条内容中提到：推进干支线飞机、直升机、通用飞机和无人机产业化。因此对无人机的研究具有极高的战略、科研及商业价值。
滑模控制在解决系统不确定性和外部扰动方面被认为是一个有效的鲁棒控制方法。滑模控制方法具有算法简单、响应速度快、对外界噪声干扰和参数摄动鲁棒性强等优点。因此，滑模控制方法被广泛应用于各个领域。对比传统线性滑模控制,非线性滑模控制的优越性在于他在满足快速跟踪的性能要求的同时兼具有更高的同步控制精度，系统的鲁棒性也较高。所以利用非线性滑模来控制四旋翼无人机系统，具有重要的理论和实际意义。
发明内容
为了满足四旋翼无人机对参考输入快速跟踪的性能要求，同时兼具更高的同步控制精度，使系统具有更高的鲁棒性，本发明提供一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，增强了系统的鲁棒性能以及同步控制精度，且保证系统快速稳定收敛。
为了解决上述技术问题提出的技术方案如下：
一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，包括以下步骤：
步骤1，建立四旋翼无人机系统的动态模型，初始化系统状态、采样时间以及控制参数，过程如下：
1.1四旋翼无人机系统的动力学模型表达形式为：
其中，x、y、z分别表示无人机在惯性坐标系下三个坐标轴的位置，m表示无人机的质量，F表示作用在无人机上的合外力，包括无人机所受重力mg和四个旋翼产生的合力UF，T是从机体坐标系到惯性坐标系的转移矩阵，表达形式为：
T＝[T1 T2 T3] (2)
1.2无人机转动过程中的力矩平衡方程为：
其中，τx、τy、τz分别代表机体坐标系上的各轴力矩分量，Ιxx、Ιyy、Ιzz分别代表机体坐标系上的各轴转动惯量分量，×表示叉乘，l、m、n分别代表机体坐标系上的各轴姿态角速度分量，分别代表机体坐标系上的各轴姿态角加速度分量；
考虑到无人机一般处于低速飞行或者悬停状态下，姿态角变化较小可设定由于存在测量噪声，电源变化以及外部干扰的影响，式(1)和式(3)中的系统参数和状态并不能准确的获得，因此联立式(1)～(3)，无人机的动力学模型表达为:
其中
分别代表模型不确定和外部干扰项；
1.3根据式(4)，对位置姿态关系进行解耦计算，结果如下：
其中arcsin为反正弦函数，arctan为反正切函数；分别是θ1，θ2，θ3的期望值；
经解耦计算后，位置与姿态角分别独立，分为两个子系统分别设计位置控制器和姿态角控制器，为控制策略提供了清晰的思路；
考虑到位置和姿态角方程都属于二阶多输入多输出非线性系统，且姿态角方程更为复杂，因此为了便于控制器的设计与阐述，式(4)表示为以下形式：
其中，
X1＝[x y z θ1 θ2 θ3]T,
B(X)＝[1 1 1 b1 b2 b3]T,U＝[Ux Uy Uz τx τy τz]T,根据飞行器的模型对应的A11＝06*6，A12＝I6*6，A21＝06*6,
即式(6)等价于
步骤2，基于带有未知参数的四旋翼无人机系统，设计所需的滑模面，过程如下：
定义系统状态跟踪误差为：
e＝Xd-X(8)其中表示为可导期望信号，表示为可导实际信号，那么式(8)的一阶微分和二阶微分表示为：
定义非线性滑模面为：
其中，F选取的是使(A11-A12 TF)有稳定的特征值和阻尼较小的极点的常数；Ψ(y)是依赖输出变化的非线性函数，用来改变系统的阻尼，它的取值范围为[-β，0]，其中β为正常数，因此，其中Ψ(y)取为以下指数形式：
α是一正常数，P为正定阵并满足：
P(A11-A12 TF)T+(A11-A12 TF)P＝-W (13)
其中W是正定阵；
当滑模面s＝0时，根据式(11)得到：
联立式(7a)和式(14)结合滑模面模型写出以下系统：
为了证明滑模面的稳定性，需要证明式(15)的稳定性，对式(15)设计李雅普诺夫函数：
定义则
因为Ψ(y)<0，所以
因为W>0，则得到所以式(15)表示的系统是稳定的；
步骤3，基于四旋翼无人机系统，根据滑模控制理论和基于误差指数型非线性函数，设计非线性滑模控制器，过程如下：
3.1考虑式(7),非线性滑模控制器被设计为：
其中K为一正常数，决定滑模面的收敛速度，且
3.2设计李雅普诺夫函数：
对式(11)进行求导得：
对式(21)进行求导并将式(22)代入得到：
根据式(8)知
其中因为设置期望值为常数所以其导数为零；所以
将式(20)代入式(25)得到
则判定系统是稳定的。
本发明基于非线性函数和滑模控制，设计一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，实现系统稳定控制，增强滑模控制的精度，保证系统快速稳定收敛。
本发明的技术构思为：针对含有动态执行机构的四旋翼无人机系统，利用非线性滑模控制方法，设计一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法。滑模面的设计是为了保证系统的快速稳定收敛。另外，采用非线性函数设计滑模面可以提高系统的鲁棒性以及跟踪精度。本发明提供一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，实现系统的快速稳定控制。
本发明的优点为：满足快速跟踪的性能要求的同时兼具有更高的同步控制精度，系统的鲁棒性也较高，补偿系统未动态参数以及内外部不确定扰动项，实现快速稳定收敛。
附图说明
图1为本发明位置滑模面k1＝1，姿态角滑模面k2＝10时的位置跟踪效果示意图，x表示x轴的位置，y表示y轴的位置，z表示z轴的位置，其中，(a)表示线性滑模面，(b)表示非线性滑模面；
图2为本发明位置滑模面k1＝1，姿态角滑模面k2＝10时的翻滚角、俯仰角和偏航角三个姿态角跟踪效果示意图，其中，(a)表示线性滑模面，(b)表示非线性滑模面；
图3为本发明位置滑模面k1＝1，姿态角滑模面k2＝10时的力矩跟踪示意图，τx表示x轴的力矩，τy表示y轴的力矩,τz表示z轴的力矩，其中，(a)表示线性滑模面，(b)表示非线性滑模面；
图4为本发明位置滑模面k1＝1，姿态角滑模面k2＝10时的控制器输入示意图，x表示控制器在x轴的输入，y表示控制器在y轴的输入，z控制器在z轴的输入，其中，(a)表示线性滑模面，(b)表示非线性滑模面；
图5为本发明的控制流程示意图。
具体实施方式
下面结合附图对本发明做进一步说明。
参照图1-图5，一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，包括以下步骤：
步骤1，建立四旋翼无人机系统的动态模型，初始化系统状态、采样时间以及控制参数，过程如下：
1.1四旋翼无人机系统的动力学模型表达形式为：
其中，x、y、z分别表示无人机在惯性坐标系下三个坐标轴的位置，m表示无人机的质量，F表示作用在无人机上的合外力，包括无人机所受重力mg和四个旋翼产生的合力UF，T是从机体坐标系到惯性坐标系的转移矩阵，表达形式为：
T＝[T1 T2 T3] (2)
1.2无人机转动过程中的力矩平衡方程为：
其中，τx、τy、τz分别代表机体坐标系上的各轴力矩分量，Ιxx、Ιyy、Ιzz分别代表机体坐标系上的各轴转动惯量分量，×表示叉乘，l、m、n分别代表机体坐标系上的各轴姿态角速度分量，分别代表机体坐标系上的各轴姿态角加速度分量；
考虑到无人机一般处于低速飞行或者悬停状态下，姿态角变化较小可设定由于存在测量噪声，电源变化以及外部干扰的影响，式(1)和式(3)中的系统参数和状态并不能准确的获得，因此联立式(1)～(3)，无人机的动力学模型表达为:
其中
分别代表模型不确定和外部干扰项；
1.3根据式(4)，对位置姿态关系进行解耦计算，结果如下：
其中，arcsin为反正弦函数，arctan为反正切函数；分别是θ1，θ2，θ3的期望值；
经解耦计算后，位置与姿态角分别独立，分为两个子系统分别设计位置控制器和姿态角控制器，为控制策略提供了清晰的思路；
考虑到位置和姿态角方程都属于二阶多输入多输出非线性系统，且姿态角方程更为复杂，因此为了便于控制器的设计与阐述，式(4)表示为以下形式：
其中，
X1＝[x y z θ1 θ2 θ3]T,
B(X)＝[1 1 1 b1 b2 b3]T,U＝[Ux Uy Uz τx τy τz]T,根据飞行器的模型对应的A11＝06*6，A12＝I6*6，A21＝06*6,
即式(6)等价于
步骤2，基于带有未知参数的四旋翼无人机系统，设计所需的滑模面，过程如下：
定义系统状态跟踪误差为：
e＝Xd-X (8)
其中表示为可导期望信号，表示为可导实际信号，那么式(8)的一阶微分和二阶微分表示为：
定义非线性滑模面为：
其中，F选取的是使(A11-A12 TF)有稳定的特征值和阻尼较小的极点的常数；Ψ(y)是依赖输出变化的非线性函数，用来改变系统的阻尼，它的取值范围为[-β，0]，其中β为正常数，因此，其中Ψ(y)取为以下指数形式：
α是一正常数，P为正定阵并满足：
P(A11-A12 TF)T+(A11-A12 TF)P＝-W (13)
其中W是正定阵；
当滑模面s＝0时，根据式(11)得到：
联立式(7a)和式(14)结合滑模面模型写出以下系统：
为了证明滑模面的稳定性，需要证明式(15)的稳定性，对式(15)设计李雅普诺夫函数：
定义则
因为Ψ(y)<0，所以
因为W>0，则得到所以式(15)表示的系统是稳定的；
步骤3，基于四旋翼无人机系统，根据滑模控制理论和基于误差指数型非线性函数，设计非线性滑模控制器，过程如下：
3.1考虑式(7),非线性滑模控制器被设计为：
其中K为一正常数，决定滑模面的收敛速度，且
3.2设计李雅普诺夫函数：
对式(11)进行求导得：
对式(21)进行求导并将式(22)代入得到：
根据式(8)知
其中因为设置期望值为常数所以其导数为零；所以
将式(20)代入式(25)得到
则判定系统是稳定的。
为验证所提方法的有效性，本发明给出了线性滑模面(Linear sliding surface,LSS)控制方法和非线性滑模面(Non-linear sliding surface,NLSS)控制方法的对比：
为了更有效的进行对比，系统所有参数都是一致的，表1给出了系统模型参数(式(3)-(5)中的参数设置)，同时系统初始状态均设为0，位置参考值给定为xd＝2m，yd＝2m，zd＝2m；偏航角参考值给定为θ3d＝0.5rad。非线性函数参数α＝2，β＝1，P＝1，F＝1。在位置滑模面中k1＝1，在姿态滑模面中k2＝10。
表1
在相同参数控制相等情况下对两种控制方法进行对比，我们可以发现两种方法都可以保证系统收敛，且具有一定的控制精度，但NLSS方法相比LSS方法具有更好的快速性，在位置和姿态角的控制上都能更快地控制到达期望值，保证了系统的快速稳定收敛。
综上所述，对比LSS方法，NLSS方法具有更好的位置跟踪精度，且控制器幅值更小。
以上阐述的是本发明给出的一个实施例表现出的优良优化效果，显然本发明不只是限于上述实施例，在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。
Claims (1)
1.一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法，其特征在于：包括以下步骤：
步骤1，建立四旋翼无人机系统的动态模型，初始化系统状态、采样时间以及控制参数，过程如下：
1.1四旋翼无人机系统的动力学模型表达形式为：
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>-</mo>
<mi>m</mi>
<mi>g</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mi>T</mi>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>U</mi>
<mi>F</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mi>m</mi>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>y</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>z</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，x、y、z分别表示无人机在惯性坐标系下三个坐标轴的位置，m表示无人机的质量，F表示作用在无人机上的合外力，包括无人机所受重力mg和四个旋翼产生的合力UF，T是从机体坐标系到惯性坐标系的转移矩阵，表达形式为：
T＝[T1 T2 T3] (2)
<mrow>
<msub>
<mi>T</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&theta;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>T</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>cos&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>cos&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>T</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>sin&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>sin&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>sin&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&theta;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>cos&theta;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
1.2无人机转动过程中的力矩平衡方程为：
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>x</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>y</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>x</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>y</mi>
<mi>y</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>z</mi>
<mi>z</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>l</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>m</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>n</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>l</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>m</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>n</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&times;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>x</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>y</mi>
<mi>y</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mrow>
<mi>z</mi>
<mi>z</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>l</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>m</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>n</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中τx、τy、τz分别代表机体坐标系上的各轴力矩分量，Ιxx、Ιyy、Ιzz分别代表机体坐标系上的各轴转动惯量分量，×表示叉乘，l、m、n分别代表机体坐标系上的各轴姿态角速度分量，分别代表机体坐标系上的各轴姿态角加速度分量；
设定联立式(1)～(3)，无人机的动力学模型表达为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>U</mi>
<mi>x</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>y</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>U</mi>
<mi>y</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>z</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>U</mi>
<mi>z</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&Psi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<msub>
<mi>&tau;</mi>
<mi>x</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&Psi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<msub>
<mi>&tau;</mi>
<mi>y</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&Psi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>3</mn>
</msub>
<msub>
<mi>&tau;</mi>
<mi>z</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
其中 分别代表模型不确定和外部干扰项；
1.3根据式(4)，对位置姿态关系进行解耦计算，结果如下：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>U</mi>
<mi>F</mi>
</msub>
<mo>=</mo>
<mi>m</mi>
<msqrt>
<mrow>
<msubsup>
<mi>U</mi>
<mi>x</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>U</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>U</mi>
<mi>z</mi>
</msub>
<mo>+</mo>
<mi>g</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&theta;</mi>
<msub>
<mn>1</mn>
<mi>d</mi>
</msub>
</msub>
<mo>=</mo>
<mi>arcsin</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>m</mi>
<msub>
<mi>U</mi>
<mi>F</mi>
</msub>
</mfrac>
<mo>(</mo>
<mrow>
<msub>
<mi>U</mi>
<mi>x</mi>
</msub>
<msub>
<mi>sin&theta;</mi>
<msub>
<mn>3</mn>
<mi>d</mi>
</msub>
</msub>
<mo>-</mo>
<msub>
<mi>U</mi>
<mi>y</mi>
</msub>
<msub>
<mi>cos&theta;</mi>
<msub>
<mn>3</mn>
<mi>d</mi>
</msub>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&theta;</mi>
<msub>
<mn>2</mn>
<mi>d</mi>
</msub>
</msub>
<mo>=</mo>
<mi>arctan</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msub>
<mi>U</mi>
<mi>z</mi>
</msub>
<mo>+</mo>
<mi>g</mi>
</mrow>
</mfrac>
<mo>(</mo>
<mrow>
<msub>
<mi>U</mi>
<mi>x</mi>
</msub>
<msub>
<mi>cos&theta;</mi>
<msub>
<mn>3</mn>
<mi>d</mi>
</msub>
</msub>
<mo>+</mo>
<msub>
<mi>U</mi>
<mi>y</mi>
</msub>
<msub>
<mi>sin&theta;</mi>
<msub>
<mn>3</mn>
<mi>d</mi>
</msub>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
其中arcsin为反正弦函数，arctan为反正切函数；θ1d，θ2d，θ3d分别是θ1，θ2，θ3的期望值；
经解耦计算后，位置与姿态角分别独立，分为两个子系统分别设计位置控制器和姿态角控制器；
式(4)表示为以下形式：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>A</mi>
<mn>11</mn>
</msub>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>A</mi>
<mn>21</mn>
</msub>
<msub>
<mi>X</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mn>22</mn>
</msub>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mi>B</mi>
<mrow>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
</mrow>
<mi>U</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>Y</mi>
<mo>=</mo>
<mi>X</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，
X1＝[x y z θ1 θ2 θ3]T,
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
<mo>,</mo>
</mrow>
B(X)＝[1 1 1 b1 b2 b3]T,U＝[Ux Uy Uz τx τy τz]T,根据飞行器的模型对应的A11＝06*6，A12＝I6*6，
<mrow>
<msub>
<mi>A</mi>
<mn>21</mn>
</msub>
<mo>=</mo>
<msub>
<mn>0</mn>
<mrow>
<mn>6</mn>
<mo>*</mo>
<mn>6</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>A</mi>
<mn>22</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
即式(6)等价于
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mi>a</mi>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>B</mi>
<mrow>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
</mrow>
<mi>U</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mi>b</mi>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>Y</mi>
<mo>=</mo>
<mi>X</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mi>c</mi>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
步骤2，基于带有未知参数的四旋翼无人机系统，设计所需的滑模面，过程如下：
定义系统状态跟踪误差为：
e＝Xd-X (8)
其中表示为可导期望信号，表示为可导实际信号，那么式(8)的一阶微分和二阶微分可以表示为：
<mrow>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mover>
<mi>e</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mover>
<mi>X</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
2
定义非线性滑模面为：
<mrow>
<mi>s</mi>
<mo>=</mo>
<msup>
<mi>C</mi>
<mi>T</mi>
</msup>
<mi>e</mi>
<mo>=</mo>
<mo>&lsqb;</mo>
<mtable>
<mtr>
<mtd>
<mrow>
<mi>F</mi>
<mo>-</mo>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<mi>P</mi>
</mrow>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
<mo>&rsqb;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，F选取的是使(A11-A12 TF)有稳定的特征值和阻尼较小的极点的常数；Ψ(y)是依赖输出变化的非线性函数，用来改变系统的阻尼，它的取值范围为[-β，0]，其中β为正常数，因此，其中Ψ(y)取为以下指数形式：
<mrow>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&beta;e</mi>
<mrow>
<mo>-</mo>
<mi>&alpha;</mi>
<msup>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>-</mo>
<mi>r</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
α是一正常数，P为正定阵并满足：
P(A11-A12TF)T+(A11-A12TF)P＝-W (13)
其中W是正定阵；
当滑模面s＝0时，根据式(11)得到：
<mrow>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>Fe</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
联立式(7a)和式(14)结合滑模面模型写出以下系统：
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>X</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>X</mi>
<mrow>
<mn>2</mn>
<mi>d</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>Fe</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>X</mi>
<mrow>
<mn>2</mn>
<mi>d</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
对式(15)设计李雅普诺夫函数：
<mrow>
<mi>V</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msubsup>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<mi>P</mi>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>F</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<mi>P</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>F</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>PA</mi>
<mn>12</mn>
</msub>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<mo>{</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>F</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mi>P</mi>
<mo>+</mo>
<mi>P</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>F</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>PA</mi>
<mn>12</mn>
</msub>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<mi>P</mi>
<mo>}</mo>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<mo>{</mo>
<mo>-</mo>
<mi>W</mi>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>PA</mi>
<mn>12</mn>
</msub>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<mi>P</mi>
<mo>}</mo>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
定义则
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>We</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mn>2</mn>
<mi>M</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>M</mi>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
因为Ψ(y)<0，所以
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<mo>-</mo>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>We</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
因为W>0，则得到所以式(15)表示的系统是稳定的；
步骤3，基于四旋翼无人机系统，根据滑模控制理论和基于误差指数型非线性函数，设计非线性滑模控制器，过程如下：
3.1考虑式(7),非线性滑模控制器被设计为：
<mrow>
<mi>u</mi>
<mo>=</mo>
<mo>-</mo>
<mi>B</mi>
<msup>
<mrow>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mi>K</mi>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>FX</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mi>&Psi;</mi>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>PX</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<msubsup>
<mi>A</mi>
<mn>12</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
其中K为一正常数，决定滑模面的收敛速度，且
<mrow>
<mfrac>
<mrow>
<mi>d</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<mn>2</mn>
<msup>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>-</mo>
<mi>r</mi>
<mo>)</mo>
</mrow>
<mn>3</mn>
</msup>
<msup>
<mi>&alpha;</mi>
<mn>2</mn>
</msup>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msup>
<msup>
<mi>&beta;e</mi>
<mrow>
<mo>-</mo>
<mi>&alpha;</mi>
<msup>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>-</mo>
<mi>r</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
3
3.2设计李雅普诺夫函数：
<mrow>
<mi>V</mi>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mi>s</mi>
<mi>T</mi>
</msup>
<mi>s</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
对式(11)进行求导得：
<mrow>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>F</mi>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<mi>P</mi>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>23</mn>
<mo>)</mo>
</mrow>
</mrow>
对式(21)进行求导并将式(22)代入得到：
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>s</mi>
<mover>
<mi>s</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>F</mi>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>&Psi;</mi>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<mi>P</mi>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>24</mn>
<mo>)</mo>
</mrow>
</mrow>
根据式(8)知
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>2</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>25</mn>
<mo>)</mo>
</mrow>
</mrow>
其中因为设置期望值为常数所以其导数为零；所以
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>F</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>&Psi;</mi>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<mi>P</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>FX</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>&Psi;</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<msub>
<mi>Pe</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>&Psi;</mi>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
<msup>
<msub>
<mi>A</mi>
<mn>12</mn>
</msub>
<mi>T</mi>
</msup>
<msub>
<mi>PX</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mi>B</mi>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
<mi>U</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>26</mn>
<mo>)</mo>
</mrow>
</mrow>
将式(20)代入式(25)得到
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>k</mi>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<mn>0</mn>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>27</mn>
<mo>)</mo>
</mrow>
</mrow>
则判定系统是稳定的。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710558755.7A CN107368088B (zh) | 2017-07-11 | 2017-07-11 | 一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710558755.7A CN107368088B (zh) | 2017-07-11 | 2017-07-11 | 一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107368088A true CN107368088A (zh) | 2017-11-21 |
| CN107368088B CN107368088B (zh) | 2019-12-03 |
Family
ID=60306005
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710558755.7A Active CN107368088B (zh) | 2017-07-11 | 2017-07-11 | 一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107368088B (zh) |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108107900A (zh) * | 2017-12-06 | 2018-06-01 | 浙江工业大学 | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法 |
| CN108107726A (zh) * | 2017-12-06 | 2018-06-01 | 浙江工业大学 | 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 |
| CN108427274A (zh) * | 2018-03-15 | 2018-08-21 | 浙江工业大学 | 基于对称时变对数正割复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法 |
| CN108549400A (zh) * | 2018-05-28 | 2018-09-18 | 浙江工业大学 | 基于对数增强型双幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法 |
| CN109828470A (zh) * | 2018-03-15 | 2019-05-31 | 浙江工业大学 | 一种四旋翼飞行器指数正切输出约束控制方法 |
| CN109917651A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种对称时变输出受限的飞行器姿态控制方法 |
| CN109917650A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种非对称时变约束的飞行器姿态控制方法 |
| CN109917652A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种飞行器对数正切全状态受限控制方法 |
| CN109932902A (zh) * | 2018-02-11 | 2019-06-25 | 浙江工业大学 | 一种四旋翼飞行器输出受限控制方法 |
| CN110347036A (zh) * | 2018-09-30 | 2019-10-18 | 哈尔滨工业大学 | 基于模糊滑模控制的无人机自主抗风智能控制方法 |
| CN110456809A (zh) * | 2019-07-30 | 2019-11-15 | 哈尔滨工程大学 | 一种减少auv横摇和纵摇的变结构综合控制器设计方法 |
| CN111399529A (zh) * | 2020-04-02 | 2020-07-10 | 上海交通大学 | 一种基于非线性滑模与前置的飞行器复合导引方法 |
| CN112180964A (zh) * | 2020-10-10 | 2021-01-05 | 中国人民解放军海军航空大学 | 一种基于非线性滑模的四旋翼飞行器的姿态跟踪方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104615142A (zh) * | 2014-12-19 | 2015-05-13 | 重庆大学 | 基于民用小型无人机的飞行控制器 |
| CN104950901A (zh) * | 2015-07-03 | 2015-09-30 | 天津大学 | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 |
| CN105138001A (zh) * | 2015-09-10 | 2015-12-09 | 中国人民解放军国防科学技术大学 | 一种四旋翼飞行器姿态控制方法 |
| CN105759832A (zh) * | 2016-05-20 | 2016-07-13 | 武汉科技大学 | 一种基于反演法的四旋翼飞行器滑模变结构控制方法 |
| CN105911866A (zh) * | 2016-06-15 | 2016-08-31 | 浙江工业大学 | 四旋翼无人飞行器的有限时间全阶滑模控制方法 |
-
2017
- 2017-07-11 CN CN201710558755.7A patent/CN107368088B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104615142A (zh) * | 2014-12-19 | 2015-05-13 | 重庆大学 | 基于民用小型无人机的飞行控制器 |
| CN104950901A (zh) * | 2015-07-03 | 2015-09-30 | 天津大学 | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 |
| CN105138001A (zh) * | 2015-09-10 | 2015-12-09 | 中国人民解放军国防科学技术大学 | 一种四旋翼飞行器姿态控制方法 |
| CN105759832A (zh) * | 2016-05-20 | 2016-07-13 | 武汉科技大学 | 一种基于反演法的四旋翼飞行器滑模变结构控制方法 |
| CN105911866A (zh) * | 2016-06-15 | 2016-08-31 | 浙江工业大学 | 四旋翼无人飞行器的有限时间全阶滑模控制方法 |
Non-Patent Citations (2)
| Title |
|---|
| 李泽: "四旋翼飞行器姿态控制系统性能优化设计", 《计算机仿真》 * |
| 王大伟等: "四旋翼无人机滑模轨迹跟踪控制器设计", 《电光与控制》 * |
Cited By (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108107900A (zh) * | 2017-12-06 | 2018-06-01 | 浙江工业大学 | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法 |
| CN108107726A (zh) * | 2017-12-06 | 2018-06-01 | 浙江工业大学 | 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 |
| CN108107726B (zh) * | 2017-12-06 | 2020-06-02 | 浙江工业大学 | 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 |
| CN108107900B (zh) * | 2017-12-06 | 2020-02-21 | 浙江工业大学 | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器全状态受限反步控制方法 |
| CN109932902A (zh) * | 2018-02-11 | 2019-06-25 | 浙江工业大学 | 一种四旋翼飞行器输出受限控制方法 |
| CN109917651A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种对称时变输出受限的飞行器姿态控制方法 |
| CN109917650A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种非对称时变约束的飞行器姿态控制方法 |
| CN109917652A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种飞行器对数正切全状态受限控制方法 |
| CN109828470A (zh) * | 2018-03-15 | 2019-05-31 | 浙江工业大学 | 一种四旋翼飞行器指数正切输出约束控制方法 |
| CN108427274A (zh) * | 2018-03-15 | 2018-08-21 | 浙江工业大学 | 基于对称时变对数正割复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法 |
| CN108549400A (zh) * | 2018-05-28 | 2018-09-18 | 浙江工业大学 | 基于对数增强型双幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法 |
| CN110347036A (zh) * | 2018-09-30 | 2019-10-18 | 哈尔滨工业大学 | 基于模糊滑模控制的无人机自主抗风智能控制方法 |
| CN110456809A (zh) * | 2019-07-30 | 2019-11-15 | 哈尔滨工程大学 | 一种减少auv横摇和纵摇的变结构综合控制器设计方法 |
| CN110456809B (zh) * | 2019-07-30 | 2022-07-15 | 哈尔滨工程大学 | 一种减少auv横摇和纵摇的变结构综合控制器设计方法 |
| CN111399529A (zh) * | 2020-04-02 | 2020-07-10 | 上海交通大学 | 一种基于非线性滑模与前置的飞行器复合导引方法 |
| CN111399529B (zh) * | 2020-04-02 | 2021-05-14 | 上海交通大学 | 一种基于非线性滑模与前置的飞行器复合导引方法 |
| CN112180964A (zh) * | 2020-10-10 | 2021-01-05 | 中国人民解放军海军航空大学 | 一种基于非线性滑模的四旋翼飞行器的姿态跟踪方法 |
| CN112180964B (zh) * | 2020-10-10 | 2022-07-22 | 中国人民解放军海军航空大学 | 一种基于非线性滑模的四旋翼飞行器的姿态跟踪方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107368088B (zh) | 2019-12-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107368088A (zh) | 一种基于误差指数型函数的四旋翼飞行器非线性滑模位姿控制方法 | |
| CN107561931B (zh) | 一种基于单指数型函数的四旋翼飞行器非线性滑模位姿控制方法 | |
| CN107368089A (zh) | 一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法 | |
| CN105911866B (zh) | 四旋翼无人飞行器的有限时间全阶滑模控制方法 | |
| CN107976903B (zh) | 一种四旋翼无人机系统的增强型双幂次趋近律滑模控制方法 | |
| Bouchoucha et al. | Classical and second order sliding mode control solution to an attitude stabilization of a four rotors helicopter: From theory to experiment | |
| CN105912009B (zh) | 基于极点配置和模糊自抗扰控制技术的四旋翼飞行器控制方法 | |
| CN104570742B (zh) | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 | |
| CN105629732B (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
| CN104765272A (zh) | 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法 | |
| CN107957682B (zh) | 一种四旋翼无人机系统的增强型快速幂次趋近律滑模控制方法 | |
| CN104360686B (zh) | 一种飞艇非奇异终端滑模航迹控制方法 | |
| CN103365296A (zh) | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 | |
| CN103885450A (zh) | 无人直升机姿态非线性控制方法及验证平台 | |
| CN107992082A (zh) | 基于分数阶幂次切换律的四旋翼无人机飞行控制方法 | |
| CN104571120A (zh) | 四旋翼无人机的姿态非线性自适应控制方法 | |
| CN103760905A (zh) | 基于模糊前馈单旋翼无人直升机姿态非线性鲁棒控制方法 | |
| CN105159305A (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
| CN108363298A (zh) | 一种基于四元数描述的四旋翼无人机快速收敛控制方法 | |
| Ansari et al. | Development and experimental investigation of a Quadrotor’s robust generalized dynamic inversion control system | |
| CN105912007A (zh) | 空间机械臂抗干扰姿态稳定的微分几何非线性控制方法 | |
| Zhang et al. | Quadrotor aircraft control without velocity measurements | |
| CN108153148A (zh) | 一种四旋翼无人机系统的增强型指数趋近律滑模控制方法 | |
| Shi et al. | Design of trajectory tracking controller with fractional-order backstepping sliding mode method for quadrotor UAV | |
| Tang et al. | Height and attitude active disturbance rejection controller design of a small-scale helicopter |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |