基于反步和滑模控制的非线性鲁棒控制器的设计方法技术

本发明专利技术公开了一种针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法。首先，针对四旋翼无人机的姿态角系统设计常速趋近律的滑模控制器，确保姿态角的快速跟踪性能。然后，为实现四旋翼无人机空间位置的轨迹跟踪能力，依照反步控制思想逐步构造滑模面和虚拟控制量来实现系统内核到外层的非线性控制律设计和系统稳定设计。在得到相关的虚拟控制量方程之后，通过算术逆运算求解方程来获取姿态角的期望轨迹值，然后利用常速滑模趋近律的设计方法来确定四旋翼无人机系统的最终输入控制律。本发明专利技术的方法利用了滑模控制对模型不确定性和外界干扰的不敏感性特点，可以实现干扰下的非线性四旋翼无人机的鲁棒轨迹跟踪控制。

【技术实现步骤摘要】

本专利技术涉及一种基于滑模控制和非线性反步控制的针对四旋翼无人机位置轨迹跟踪的控制方法，属于无人机控制

技术介绍
作为无人机家族的新生成员，四旋翼无人机以其在实际应用领域里的重要而广泛的用途而受到许多学者和研究人员的关注，引起了他们的极大兴趣。四旋翼无人机在军事侦察、自然灾害监控、农业成像和救援任务中发挥着越来越重要的作用。这种无人机的主要优势在于垂直起降、定高悬浮以及任意方向飞行。尽管存在这么多的应用优势，但是四旋翼无人机本身的一些特点，如非线性、强耦合和欠驱动等，使得飞行高品质和机动性难以得到有效保证。目前的一些常用的控制方法主要是针对线性化之后的各个平衡点上的线性模型，具有动态范围小、模型不精确、抗干扰能力差等缺点。其他的控制方法，例如基于人工智能的神经网络控制方法、模糊控制方法等，目前只在软件仿真平台上进行了验证，实现性和大范围的推广还需要很长时间。基于非线性反步控制和滑模控制的控制方法以其在抗干扰性、精确性、鲁棒性、实现性和动态范围上所拥有明显优势而在众多控制方法中脱颖而出，对实现四旋翼无人机的轨迹跟踪控制具有十分重要的意义。反步控制方法是由PetarV.Kokotovic等人在1990年左右提出的一种针对非线性动态系统进行镇定控制设计的方法，在针对一类非线性系统进行控制器设计时非常有效。这一类非线性系统一般建立在某些子系统之上，而这些子系统本身可以通过其他的控制方法实现镇定。通常，可以将将复杂的非线性系统分解成不超过系统阶数的子系统，然后从内核开始为每个子系统部分设计李雅普诺夫函数和中间虚拟控制量，并一直将这个过程“后退”到整个系统，最后把每个子系统的李雅普诺夫函数集成起来保证整个系统的稳定性。这种从复杂非线性系统的内核开始设计，以反馈的方式实现，由内到外逐层设计直至得到最终形式的控制律，并保证系统的稳定性的过程就是典型的反步控制过程。在反步过程中需要设计虚拟控制量来保证子系统的稳定，同时这些虚拟量的设计还要尽量满足系统的调节或跟踪的能力，使系统达到期望的性能指标。这种逐步迭代的过程可以通过符号代数软件来实现，方便快捷，进一步促进了反步控制在非线性领域广泛应用。滑模控制是一种利用不连续控制信号改变非线性系统动态特性的非线性控制方法。这种不连续控制信号迫使系统在常态行为的超平面附近滑动，从而使得系统具有期望的动态性能。滑模控制是一种变结构的控制方法，系统结构总是依据当前的状态位置信息在不同的结构之间进行切换，而且使用滑模控制方法设计的状态反馈控制律一般也不是时间的连续函数。滑模变结构控制的原理是根据系统所期望的动态特性来设计系统的切换超平面，通过滑动模态控制器使系统状态从超平面之外向切换超平面收束。系统一旦到达切换超平面，控制作用将保证系统沿切换超平面到达系统原点，这一沿切换超平面向原点滑动的过程称为滑模控制。在滑模控制中，系统的动态特性和超平面的选取以及滑模控制器的趋近律密切相关，不受外界干扰影响，对模型参数变化不敏感，从而使得滑模变结构控制具有很强的鲁棒性。另一方面，滑模控制不需要在线辨识，控制律一般都是通过状态或输出反馈实现，从而使得滑模控制具有响应速度快的优点。
技术实现思路
专利技术目的：为了克服现有技术中存在的不足，本专利技术提供一种针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法，该方法针对复杂非线性模型，能够有效避免局部线性化带来的不精确性；动态响应范围大，克服线性微分积分控制在平衡点动态小范围的限制；给出了整体统一的非线性控制器，避免了控制器之间切换带来的负面效应。技术方案：为实现上述目的，本专利技术采用的技术方案为：一种针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法，包括以下步骤：步骤1，获取四旋翼无人机的实际位置轨迹、位置参考轨迹和偏航角参考轨迹；根据实际位置轨迹和位置参考轨迹依次建立关于各个状态变量的跟踪误差动态子系统，所有的跟踪误差动态子系统组成跟踪误差动态系统；所述状态变量包括姿态角及其一阶导数、位置及其一阶导数。步骤2，根据步骤1建立的跟踪误差动态系统，设计能够保证误差系统稳定并且收敛的反馈渐近跟踪的反步滑模控制器；所述反步滑模控制器利用反步控制的思想为跟踪误差动态系统的每一个跟踪误差动态子系统设计相应的虚拟控制量和滑模面，逐层保证的跟踪误差动态子系统稳定性和动态性能，直到获取能够保证位置轨迹跟踪能力并且关于姿态角状态和实际输入的虚拟控制量。步骤3，对步骤2得到的虚拟控制量进行算术求逆，求取四旋翼无人机姿态角期望值,该姿态角期望值包括滚转角期望轨迹、俯仰角期望轨迹和四旋翼无人机的第四控制分量。步骤4，针对步骤3得到的滚转角期望轨迹、俯仰角期望轨迹以及步骤1获取的偏航角参考轨迹分别设计基于常速趋近的姿态角常规滑模跟踪控制器，根据该姿态角常规滑模跟踪控制器得到四旋翼无人机的滑模控制律，所述滑模控制律包括第一控制分量、第二控制分量以及第三控制分量。步骤5，四旋翼无人机在根据步骤3得到的第四控制分量以及步骤4得到的滑模控制律的作用下对参考轨迹进行跟踪，进而实现干扰下的非线性四旋翼无人机的鲁棒轨迹跟踪控制。优选的：所述步骤1中的四旋翼无人机的非线性模型为：其中，是系统的状态变量；其物理含义依次是姿态角(φ,θ,ψ)及其一阶导数位置(x,y,z)及其一阶导数可整体表示如下φ为滚转角，θ为俯仰角，ψ为偏航角，ai,i＝1,2,…11是规范化的已知常值参数；是在线辨识值，g是重力加速度，Ui,i＝1,2,3,4是系统的实际控制输入量，Ui,i＝1,2,3,4按顺序依次为第一控制分量、第二控制分量、第三控制分量以及第四控制分量，S(·)和C(·)分别表示三角正弦和余弦函数。优选的：所述步骤2中的虚拟控制量为：v2=v·1+z7+a9x8+ρ2sp1]]>v4=v·3+z9+a10x10+ρ4sp2]]>v6=v·5+z11+g+a11x12+ρ6sp3;]]>其中，v2i,i＝1,2,3为虚拟控制量，v2i-1在获取v2i之间已经确定并且其一阶导数可以通过对v2i-1进行一阶微分滤波获取，z7、z9、z11分别是位置(x,y,z)的跟踪误差，且z7＝x7r-x7，z9＝x9r-x9，z11＝x11r-x11；x7r、x9r、x11r分别是位置(x,y,z)的参考轨迹，ρ2、ρ4、ρ6是位置(x,y,z)的可选的常值正实数，sp1、sp2、sp2分别是本文档来自技高网...

【技术保护点】
一种针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法，其特征在于，包括以下步骤：步骤1，获取四旋翼无人机的实际位置轨迹、位置参考轨迹和偏航角参考轨迹；根据实际位置轨迹和位置参考轨迹依次建立关于各个状态变量的跟踪误差动态子系统，所有的跟踪误差动态子系统组成跟踪误差动态系统；所述状态变量包括姿态角及其一阶导数、位置及其一阶导数；步骤2，根据步骤1建立的跟踪误差动态系统，设计能够保证误差系统稳定并且收敛的反馈渐近跟踪的反步滑模控制器；所述反步滑模控制器利用反步控制的思想为跟踪误差动态系统的每一个跟踪误差动态子系统设计相应的虚拟控制量和滑模面，逐层保证的跟踪误差动态子系统稳定性和动态性能，直到获取能够保证位置轨迹跟踪能力并且关于姿态角状态和实际输入的虚拟控制量；步骤3，对步骤2得到的虚拟控制量进行算术求逆，求取四旋翼无人机姿态角期望值,该姿态角期望值包括滚转角期望轨迹、俯仰角期望轨迹和四旋翼无人机的第四控制分量；步骤4，针对步骤3得到的滚转角期望轨迹、俯仰角期望轨迹以及步骤1获取的偏航角参考轨迹分别设计基于常速趋近的姿态角常规滑模跟踪控制器，根据该姿态角常规滑模跟踪控制器得到四旋翼无人机的滑模控制律，所述滑模控制律包括第一控制分量、第二控制分量以及第三控制分量；步骤5，四旋翼无人机在根据步骤3得到的第四控制分量以及步骤4得到的滑模控制律的作用下对位置参考轨迹和偏航角参考轨迹进行跟踪，进而实现干扰下的非线性四旋翼无人机的鲁棒轨迹跟踪控制。...

【技术特征摘要】
1.一种针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制
器的设计方法，其特征在于，包括以下步骤：
步骤1，获取四旋翼无人机的实际位置轨迹、位置参考轨迹和偏航角参考轨迹；根据实
际位置轨迹和位置参考轨迹依次建立关于各个状态变量的跟踪误差动态子系统，所有的跟
踪误差动态子系统组成跟踪误差动态系统；所述状态变量包括姿态角及其一阶导数、位置
及其一阶导数；
步骤2，根据步骤1建立的跟踪误差动态系统，设计能够保证误差系统稳定并且收敛的
反馈渐近跟踪的反步滑模控制器；所述反步滑模控制器利用反步控制的思想为跟踪误差动
态系统的每一个跟踪误差动态子系统设计相应的虚拟控制量和滑模面，逐层保证的跟踪误
差动态子系统稳定性和动态性能，直到获取能够保证位置轨迹跟踪能力并且关于姿态角状
态和实际输入的虚拟控制量；
步骤3，对步骤2得到的虚拟控制量进行算术求逆，求取四旋翼无人机姿态角期望值,该
姿态角期望值包括滚转角期望轨迹、俯仰角期望轨迹和四旋翼无人机的第四控制分量；
步骤4，针对步骤3得到的滚转角期望轨迹、俯仰角期望轨迹以及步骤1获取的偏航角参
考轨迹分别设计基于常速趋近的姿态角常规滑模跟踪控制器，根据该姿态角常规滑模跟踪
控制器得到四旋翼无人机的滑模控制律，所述滑模控制律包括第一控制分量、第二控制分
量以及第三控制分量；
步骤5，四旋翼无人机在根据步骤3得到的第四控制分量以及步骤4得到的滑模控制律
的作用下对位置参考轨迹和偏航角参考轨迹进行跟踪，进而实现干扰下的非线性四旋翼无
人机的鲁棒轨迹跟踪控制。
2.根据权利要求1所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述步骤1中的四旋翼无人机的非线性模型
为：
其中，是系统的状态变量；其物理含义
依次是姿态角(φ,θ,ψ)及其一阶导数位置(x,y,z)及其一阶导数可整
体表示如下φ为滚转角，θ为俯仰角，ψ为偏航角，
ai,i＝1,2,…11是规范化的已知常值参数；是在线辨识值，g是重力加速度，Ui,i＝1,2,
3,4是系统的实际控制输入量，Ui,i＝1,2,3,4按顺序依次为第一控制分量、第二控制分量、
第三控制分量以及第四控制分量，S(·)和C(·)分别表示三角正弦和余弦函数。
3.根据权利要求1所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述步骤2中的虚拟控制量为：
v2=v·1+z7+a9x8+ρ2sp1]]>v4=v·3+z9+a10x10+ρ4sp2]]>v6=v·5+z11+g+a11x12+ρ6sp3;]]>其中，v2i,i＝1,2,3为虚拟控制量，v2i-1在获取v2i之间已经确定并且其一阶导数可
以通过对v2i-1进行一阶微分滤波获取，z7、z9、z11分别是位置(x,y,z)的跟踪误差，且z7＝x7r-
x7，z9＝x9r-x9，z11＝x11r-x11；x7r、x9r、x11r分别是位置(x,y,z)的参考轨迹，ρ2、ρ4、ρ6是位置
(x,y,z)的可选的常值正实数，sp1、sp2、sp2分别是滑模面，其中下标p的表示滑模面是为位置
状态量的跟踪而设计的滑模面。
4.根据权利要求1所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述步骤3中在进行算术求逆的虚拟控制量方
程为：
v2=(Cx1Sx3Cx5+Sx1Sx5)U4]]>v4=(Cx1Sx3Sx5-Sx1Sx5)U4]]>v6=(Cx1Cx3)U4;]]>其中，v2i,i＝1,2,3为虚拟控制量，S(·)和C(·)分别表示三角正弦和余弦函数，U4表示第
四控制分量，x1,x3,x5分别表示滚转角φ，俯仰角θ，偏航角ψ。
5.根据权利要求1所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述步骤3中的姿态角期望轨迹和第四控制分
量为：
x1d=arctan(acv6-lv4av6c2+l2)x3d=arctan(cl)U4=a2(c2+l2)v62+(acv6-lv4)2al;]]>其中，x1d表示滚转角期望轨迹、x3d表示俯仰角期望轨迹，U4表示第四控制分量，a＝cos
(x5r)，b＝sin(x5r)，c＝(v2+v4)/v6，l＝a+b。
6.根据权利要求1所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述步骤4中得到的滑模控制律为：
其中，Ui,i＝1,2,3分别是第一控制分量、第二控制分量、第三控制分量，z1,z3,z5分别是
关于位置轨迹(x,y,z)跟踪误差，且z1＝x7r-x7，z3＝x9r-x9，z5＝x11r-x11，其中x7r、x9r、x11r分
别为位置(x,y,z)的参考轨迹，s1(z1)、s3(z3)、s5(z5)分别是针对姿态角控制设计的滑模面，
k1,k2,k3分别是另外一组可选的常值正实数。
7.根据权利要求6所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述滑模面选取如下：
s1=ϵ·1+c1ϵ1s2=ϵ·2+c2ϵ2s3=ϵ·3+c3ϵ3;]]>其中，s1(z1),s3(z3),s5(z5)分别是针对跟踪位置的滑模面，εi＝ηid-ηi,i＝1,3,5是对应
的姿态角跟踪误差，ci,i＝1,2,3是可选正实数并且与控制律的趋近速度有关参数。
8.根据权利要求1所述的针对四旋翼无人机非线性模型的基于反步和滑模控制技术的
非线性鲁棒控制器的设计方法，其特征在于：所述步骤2中虚拟控制量选取方法如下：
第一步，为位置...

【专利技术属性】
技术研发人员：陆俊杰，陈复扬，程子安，胡龙泽，张康康，姜斌，蒋荣强，雷稳，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：江苏;32