一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法技术

一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，针对含有动态执行机构的四旋翼无人机系统，利用非线性滑模控制方法，设计一种四旋翼无人机系统非线性滑模位姿控制方法。滑模面的设计是为了保证系统的快速稳定收敛。另外，采用非线性函数设计滑模面可以提高系统的鲁棒性以及跟踪精度。本发明专利技术提供一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，实现系统的快速稳定控制。

A nonlinear sliding mode attitude control method for four rotor aircraft based on double exponential function

A nonlinear sliding mode four rotorhelicopter double exponential function of the position control method based on the dynamic actuator four rotor UAV system, the nonlinear sliding mode control method, a design method of four rotor nonlinear sliding mode position control system. The sliding surface design is designed to guarantee the fast and stable convergence of the system. In addition, the design of sliding surface with nonlinear function can improve the robustness and tracking precision of the system. The invention provides a nonlinear sliding mode attitude control method of four rotor aircraft based on double exponential type function, and realizes the fast and stable control of the system.

【技术实现步骤摘要】
一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法
本专利技术涉及一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，以满足四旋翼无人机对参考输入快速准确跟踪的性能要求。
技术介绍
无人机(UnmannedAerialVehicle,UAV)是通过远程遥控或基于无人机自身传感器实现自主飞行的飞行器。随着其技术的不断成熟,已被应用于民用、军用的很多领域。无人机可以分为固定翼和旋翼两种,固定翼无人机的优点是能量效率高，因此飞行距离和时间都较长，小型滑翔机在风速不大时也比较容易控制，但是它们被设计为无人形式时，操作性较差。相比而言，旋翼无人机则具有很强的可操作性，且机动性强，能够很方便地完成起飞与降落等动作，对工作环境的要求也比较低。四旋翼无人机作为旋翼式无人机的一种,以其体积小、机动性能好、设计简单、制造成本低廉等优点,吸引了国内外大学、研究机构、公司的广泛关注。旋翼无人机非常适合用于监视、侦察等民用和军用领域。在民用领域,旋翼无人机主要被应用于抗灾救险、地面监测、高空航拍等；由于其隐蔽性髙,可靠性好,也被用于战场监控、军事侦察等军用领域。在国外无人机研究也是一大热点，其中美国航空航天局(NASA)已经研制出了十旋翼的无人驾驶飞机用于战略探测及科学研究，还开发出了可使大型无人机与有人驾驶航空器一同在国家空域内安全飞行的技术；在国内无人机研究也受到高度重视，在“十三五”规划的第五部分高端装备，第18条内容中提到：推进干支线飞机、直升机、通用飞机和无人机产业化。因此对无人机的研究具有极高的战略、科研及商业价值。滑模控制在解决系统不确定性和外部扰动方面被认为是一个有效的鲁棒控制方法。滑模控制方法具有算法简单、响应速度快、对外界噪声干扰和参数摄动鲁棒性强等优点。因此，滑模控制方法被广泛应用于各个领域。对比传统线性滑模控制,非线性滑模控制的优越性在于他在满足快速跟踪的性能要求的同时兼具有更高的同步控制精度，系统的鲁棒性也较高。所以利用非线性滑模来控制四旋翼无人机系统，具有重要的理论和实际意义。
技术实现思路
为了满足四旋翼无人机对参考输入快速跟踪的性能要求，同时兼具更高的同步控制精度，使系统具有更高的鲁棒性，本专利技术提供一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，增强了系统的鲁棒性能以及同步控制精度，且保证系统快速稳定收敛。为了解决上述技术问题提出的技术方案如下：一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，包括以下步骤：步骤1，建立四旋翼无人机系统的动态模型，初始化系统状态、采样时间以及控制参数，过程如下：1.1四旋翼无人机系统的动力学模型表达形式为：其中，x、y、z分别表示无人机在惯性坐标系下三个坐标轴的位置，m表示无人机的质量，F表示作用在无人机上的合外力，包括无人机所受重力mg和四个旋翼产生的合力UF，T是从机体坐标系到惯性坐标系的转移矩阵，表达形式为：T＝[T1T2T3](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＝[xyzθ1θ2θ3]T,B(X)＝[111b1b2b3]T,U＝[UxUyUzτxτyτz]T,根据飞行器的模型对应的A11＝06*6，A12＝I6*6，即式(6)等价于步骤2，基于带有未知参数的四旋翼无人机系统，设计所需的滑模面，过程如下：定义系统状态跟踪误差为：e＝Xd-X(8)其中表示为可导期望信号，表示为可导实际信号，那么式(8)的一阶微分和二阶微分表示为：定义非线性滑模面为：其中，F选取的是使(A11-A12TF)有稳定的特征值和阻尼较小的极点的常数；Ψ(y)是依赖输出变化的非线性函数，用来改变系统的阻尼，它的取值范围为[-β，0]，其中β为正常数，因此，其中Ψ(y)取为以下双指数形式：y0是初始输出状态，r是期望输出状态，P为正定阵并满足：P(A11-A12TF)T+(A11-A12TF)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＝本文档来自技高网...

【技术保护点】
一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，其特征在于：包括以下步骤：步骤1，建立四旋翼无人机系统的动态模型，初始化系统状态、采样时间以及控制参数，过程如下：1.1四旋翼无人机系统的动力学模型表达形式为：

【技术特征摘要】
1.一种基于双指数型函数的四旋翼飞行器非线性滑模位姿控制方法，其特征在于：包括以下步骤：步骤1，建立四旋翼无人机系统的动态模型，初始化系统状态、采样时间以及控制参数，过程如下：1.1四旋翼无人机系统的动力学模型表达形式为：其中，x、y、z分别表示无人机在惯性坐标系下三个坐标轴的位置，m表示无人机的质量，F表示作用在无人机上的合外力，包括无人机所受重力mg和四个旋翼产生的合力UF，T是从机体坐标系到惯性坐标系的转移矩阵，表达形式为：T＝[T1T2T3](2)1.2无人机转动过程中的力矩平衡方程为：其中，τx、τy、τz分别代表机体坐标系上的各轴力矩分量，Ιxx、Ιyy、Ιzz分别代表机体坐标系上的各轴转动惯量分量，×表示叉乘，l、m、n分别代表机体坐标系上的各轴姿态角速度分量，分别代表机体坐标系上的各轴姿态角加速度分量；设定联立式(1)～(3)，无人机的动力学模型表达为:其中分别代表模型不确定和外部干扰项；1.3根据式(4)，对位置姿态关系进行解耦计算，结果如下：其中arcsin为反正弦函数，arctan为反正切函数；分别是θ1，θ2，θ3的期望值；经解耦计算后，位置与姿态角分别独立，分为两个子系统分别设计位置控制器和姿态角控制器；式(4)表示为以下形式：其中，X1＝[xyzθ1θ2θ3]T,B(X)＝[111b1b2b3]T,U＝[UxUyUzτxτyτz]T,根据飞行器的模型对应的A11＝06*6，A12＝I6*6，A21＝06*6,即式(6)等价于步骤2，基...

【专利技术属性】
技术研发人员：陈强，胡如海，陈凯杰，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33