CN113050683B - 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法 - Google Patents
一种基于终端滑模控制的固定时间四旋翼飞行器控制方法 Download PDFInfo
- Publication number
- CN113050683B CN113050683B CN202110270909.9A CN202110270909A CN113050683B CN 113050683 B CN113050683 B CN 113050683B CN 202110270909 A CN202110270909 A CN 202110270909A CN 113050683 B CN113050683 B CN 113050683B
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- rotor
- aircraft
- fixed time
- terminal sliding
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 11
- 238000012545 processing Methods 0.000 claims abstract description 4
- 230000008569 process Effects 0.000 claims description 11
- 238000011217 control strategy Methods 0.000 claims description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000012938 design process Methods 0.000 claims description 2
- 238000004088 simulation Methods 0.000 abstract description 6
- 238000000354 decomposition reaction Methods 0.000 abstract description 2
- 230000000694 effects Effects 0.000 description 8
- 238000013461 design Methods 0.000 description 7
- 230000008901 benefit Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002265 prevention 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,包括建立基于拉格朗日方程的四旋翼飞行器非线性动力学模型;将四旋翼模型进行面向控制处理,基于时间尺度分解法把四旋翼解耦成位置***和姿态***;采用非奇异终端滑模策略,为位置***和姿态***设计了固定时间控制器,实现了四旋翼***的位置误差和姿态误差均可在固定时间内趋向于零;基于固定时间理论设计非奇异终端滑模函数,收敛时间上界取决于控制器参数,与初始***状态无关;仿真结果证明,本发明设计的终端滑模固定时间控制器有着较好的收敛速度,且避免了奇异性问题,为四旋翼相关控制问题的研究开拓了很好的思路,具有跟踪能力、快速性和鲁棒性好的特点。
Description
技术领域
本发明涉及飞行器控制技术领域,具体涉及一种基于终端滑模控制的固定时间四旋翼飞行器控制方法。
背景技术
四旋翼无人飞行器由于具有体积小、重量轻、飞行快等飞行优势,以及飞行姿态灵活、悬停自由等特有的性能而受到广泛关注,成为无人机方向研究的热点,并且在军事、民用以及商业领域得到了诸多应用;在军事上,不但可以对敌情进行侦查、监视和战场评估,还可以用于目标搜索,通信中继,边境巡逻等特殊任务,甚至在战争中还可以被当作微型攻击武器,对对方实施电子战或者直接打击目标;在民用上,无人机已经被广泛应用于气象、通信、灾害监测等领域,比如用于森达防火监测,搜寻灾难幸存者或者有害气体污染源,火山探险等人类无法到达的一些恶劣环境;目前已发展运用到民用航拍、货物运输、医疗急救、故障诊断等更多行业;
然而,四旋翼飞行器由于其控制***的高度非线性,输入输出变量之间的强耦合性,以及***本身的不确定性和外界未知的干扰,使得对无人机的控制变得十分复杂;目前四旋翼飞行器控制方法主要有经典的PID控制、滑模变结构控制、模糊控制以及神经网络控制等方法,这些方法都有其各自的特点;如何能够设计出既能精确控制又有良好稳定性的控制***,是四旋翼飞行器发展面临的重要挑战,也是需要解决的主要难点问题;
近年来,由于滑模变结构控制具有不受***参数和外部干扰的影响的优点,因此被广泛应用于非线性***控制问题中;滑模变结构控制实质上为一种变控制结构的非线性算法,其工作本质是根据***状态、偏差等状态变量不断地调整被控***的控制输入,使***状态轨迹在控制输入的作用下能够到达且沿着预先确定的“滑动模态”运动,直至平衡位置;该方法不依赖***准确模型,并且控制效果不易受被控对象数学参数以及各种扰动因素的影响,因此相较于其他控制算法鲁棒性更强,为四旋翼相关控制问题的研究开拓了很好的思路。
发明内容
针对上述存在的问题,本发明旨在提供一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,通过采用固定时间理论设计非奇异终端滑模控制器,使得得到的四旋翼飞行器具备较好的跟踪性能,并且具备一定的快速性和鲁棒性,为四旋翼相关控制问题的研究开拓了很好的思路,具有跟踪能力、快速性和鲁棒性好的特点。
为了实现上述目的,本发明所采用的技术方案如下:
一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,包括
步骤一:首先建立基于拉格朗日方程的四旋翼飞行器的非线性动力学模型;
步骤二:将四旋翼飞行器非线性动力学模型转化为包括位置***和姿态***的二阶非线性***形式;
步骤三:基于四旋翼飞行器欠驱动的特点,求解位置模型的中间指令信号θd,ψd;
步骤四:根据步骤二和步骤三的模型处理结果,设计基于固定时间理论的非奇异终端滑模函数;
步骤五:以步骤四非奇异终端滑模函数为控制策略,设计非奇异终端滑模固定时间控制器,使***位置及姿态轨迹跟踪误差在固定时间收敛到零。
优选的,步骤一所述的基于拉格朗日方程的四旋翼飞行器的非线性动力学模型为:
其中:飞行器的三个姿态的欧拉角度表示为Ω=[φ,θ,ψ],分别代表滚转角、俯仰角和偏航角;角速度表示为飞行器质心在惯性坐标系中的位置坐标表示为P=[x,y,z];速度表示为/>飞行器半径长度l表示每个旋翼末端到飞行器重心的距离;m代表四旋翼飞行器的负载总重量;Ii代表围绕每个轴的转动惯量;Ki为阻力系数;di(i=1,2,3,4,5,6)为扰动,并假设时变扰动di,i=1,...,6有界且上界已知,即存在正实数λ,使得|di|≤λ,所有扰动均有界;
将飞行器每个旋翼产生的推力用Fi表示,ui为虚拟控制输入,i=1,2,3,4,…,定义如下:
其中:R代表比例系数。
优选的,步骤二所述的将四旋翼飞行器非线性动力学模型转化为二阶非线性***形式的过程具体包括:
S201.首先,设待设计的虚拟控制输入为:
则式(1)中用来描述位置状态的四旋翼动力学模型变为:
S202.令up=[u1x,u1y,u1z]T,fp=-[0,0,g]T-diag([K1/m,K2/m,K3/m])·v,令P=[x,y,z]表示三维位置,v表示速度,则式(1)中的四旋翼飞行器位置模型可以写成如下二阶非线性***形式:
S203.同理,令uο=[u2,u3,u4]T,fο=-diag[lK4/I1,lK5/I2,lK6/I3]·ω,dο=[d4,d5,d6]T,则式(4)所述四旋翼飞行器姿态模型可以写成如下二阶非线性***形式:
S204.设 则四旋翼飞行器***可以转化为如下二阶***形式:
优选的,步骤三所述的基于四旋翼飞行器欠驱动的特点求解中间指令信号的求解过程包括:
S301.由四旋翼飞行器的控制输入可得:
S302.由于则式(8)变为:
S303.由于u1z=u1 cosφcosψd,可得则式(9)变为:
S304.再由式(10)可得:
S305.此时,根据式(11)可以求解出ψd和θd为:
优选的,步骤S305所述的θd的虚拟参考指令为
其中:
优选的,步骤四所述的基于固定时间理论设计非奇异终端滑模函数的具体过程包括:
S401.针对二阶非线性***
设x=0时为***的平衡状态,若存在连续的径向无界的函数V:R→R+∪{0},使且***的任意解x(t)满足式
在式(14)中:a、b、p、q、k均为正数且满足pk<1,qk>1,则***的零平衡状态是全局固定时间稳定的,并且解决时间上限T满足下列不等式:
S402.设跟踪误差根据固定时间理论构造下列非奇异终端滑模面为:
在式(16)中,ai>0,bi>0,均为正奇数,j=1,2,3,…,且有
优选的,步骤五所述的非奇异终端滑模固定时间控制器的设计过程包括:
在式(17)中,k=2λ,非线性函数μi定义如下:
在式(18)中,当x→0时,非线性函数μi(x)/x→0。
本发明的有益效果是:本发明公开了一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,与现有技术相比,本发明的改进之处在于:
(1)针对现有技术中存在的问题,本发明设计了一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,本控制方法在四旋翼飞行器欠驱动特性下,通过选择四旋翼飞行器的跟踪航迹(xd,yd,zd)和滚转角φd,根据位置模型求解中间指令信号θd,ψd,并传递给姿态模型,完成了四旋翼飞行器姿态和位置的全局控制;
(2)同时本控制方法通过基于固定时间理论构造非奇异终端滑模函数,并给出了与初始状态无关的***状态收敛时间上界;且通过采用非线性函数μi(x)避免了奇异问题;仿真结果表明通过本控制方法设计的控制器具有良好的鲁棒性,能够很好的执行三维空间轨迹跟踪的任务,并且***状态误差的收敛速度均小于给出的时间上界,验证了设计的有效性,说明本方法具有跟踪能力、快速性和鲁棒性好的优点。
附图说明
图1为本发明基于终端滑模控制的固定时间四旋翼飞行器控制方法的控制流程图。
图2为本发明实施例1飞行器轨迹跟踪3D效果图。
图3为本发明实施例1飞行器位置跟踪曲线图。
图4为本发明实施例1飞行器姿态跟踪曲线图。
图5为本发明实施例1位置跟踪误差图。
图6为本发明实施例1姿态跟踪误差图。
图7为本发明实施例1位置***控制输入图。
图8为本发明实施例1姿态***控制输入图。
具体实施方式
为了使本领域的普通技术人员能更好的理解本发明的技术方案,下面结合附图和实施例对本发明的技术方案做进一步的描述。
参照附图1-8所示的一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,本方法采用固定时间理论设计非奇异终端滑模控制器,按照如下的步骤进行:
步骤一:首先建立基于拉格朗日方程的四旋翼飞行器的非线性动力学模型:
其中:飞行器的三个姿态的欧拉角度表示为Ω=[φ,θ,ψ],分别代表滚转角、俯仰角和偏航角;角速度表示为飞行器质心在惯性坐标系中的位置坐标表示为P=[x,y,z];速度表示为/>飞行器半径长度l表示每个旋翼末端到飞行器重心的距离;m代表四旋翼飞行器的负载总重量;Ii代表围绕每个轴的转动惯量;Ki为阻力系数;di(i=1,2,3,4,5,6)为扰动,并假设时变扰动di,i=1,...,6有界且上界已知,即存在正实数λ,使得|di|≤λ,所有扰动均有界;
将飞行器每个旋翼产生的推力用Fi表示,ui为虚拟控制输入,i=1,2,3,4,…,定义如下:
其中:R代表比例系数;
步骤二:将四旋翼飞行器非线性动力学模型转化为二阶非线性***形式,具体包括
S201.首先,为了简化后续控制算法分析步骤,令设待设计的虚拟控制输入为:
则式(1)中用来描述位置状态的四旋翼动力学模型变为:
S202.令up=[u1x,u1y,u1z]T,fp=-[0,0,g]T-diag([K1/m,K2/m,K3/m])·v,令P=[x,y,z]表示三维位置,v表示速度,则式(1)中的四旋翼飞行器位置模型可以写成如下二阶非线性***形式:
S203.同理,令uο=[u2,u3,u4]T,fο=-diag[lK4/I1,lK5/I2,lK6/I3]·ω,dο=[d4,d5,d6]T,则式(4)所述四旋翼飞行器姿态模型可以写成如下二阶非线性***形式:
S204.定义 将上式(2)-式(6)进行整合,则四旋翼飞行器***可以转化为如下二阶***形式:
步骤三:基于四旋翼飞行器欠驱动的特点,求解位置模型的中间指令信号θd,ψd,具体为在***欠驱动下追踪四个在***欠驱动下追踪四个自由度,分别为三维位置[x,y,z]和滚转角φ,同时应保证另外两个角度稳定;
S301.由四旋翼飞行器的控制输入可得:
S302.由于则式(8)变为:
S303.由于u1z=u1 cosφcosψd,可得则式(9)变为:
S304.再由式(10)可得:
S305.此时,根据式(11)可以求解出ψd和θd为:
如果式(13)中的sinθd超出[-1,1],会造成θd不存在,即无法求解,解决方法为针对θd设计虚拟参考指令为:
其中:
步骤四:步骤二和步骤三的模型处理,使得四旋翼模型满足了终端滑模控制所需的***形式,设计基于固定时间理论的非奇异终端滑模函数,具体过程为:
S401.针对二阶非线性***
设x=0时为***的平衡状态,若存在连续的径向无界的函数V:R→R+∪{0},使且***的任意解x(t)满足式
在式(14)中:a、b、p、q、k均为正数且满足pk<1,qk>1,则***的零平衡状态是全局固定时间稳定的,并且解决时间上限T满足下列不等式:
S403.设跟踪误差根据固定时间理论构造下列非奇异终端滑模面为:
在式(16)中,ai>0,bi>0,为正奇数,j=1,2,3,…,且有
步骤五:设计非奇异终端滑模固定时间控制器,使***位置及姿态轨迹跟踪误差在固定时间收敛到零,所述非奇异终端滑模固定时间控制器的设计过程包括:
在式(17)中,k=2λ,非线性函数μi定义如下:
在式(18)中,当x→0时,非线性函数μi(x)/x→0,这一特性可以保证控制器中式(18)是有界的,避免了常规滑模控制中奇异问题的出现,并且在该控制器作用下,则***位置及姿态轨迹跟踪误差在固定时间收敛到零,其证明过程如下:
根据式(16),对滑模函数的微分可得
将式(7)代入式(19),可得
将控制器式(17)代入式(20)中,得到
选择Lyapunov函数Vi=|si|,i=1,...,6,对其微分可得:
如果由式(18)可知/>因此
根据(14)和(15)可得,Vi将在固定时间内收敛到零或是进入区域/>其中
当基于式(17),可得:
当时,有/>可得Vi将在固定时间/>内离开/>
其中:
因此,收敛时间上界可表示为
在控制器作用下,四旋翼飞行器位置及姿态轨迹跟踪误差在固定时间收敛到零,在任意初始条件下收敛时间上界Tmax是确定的,由控制参数ai>0,bi>0,和τ,k决定。
优选的,作为一种非线性控制方法,步骤二中,需要将四旋翼飞行器动力学模型中位置和姿态这六个自由度均转化为对应的六个二阶非线性***模式(基于时间尺度分解法把四旋翼解耦成位置***和姿态***),并对模型进行解耦来满足滑模变结构控制的要求。
优选的,作为一种包含姿态和位置的全局控制策略,步骤三中,四旋翼飞行器具有四个输入,分别对应四个转子产生的升力,而需要追踪的输出有六个,即三维位置和俯仰,偏航和滚转角,这表明四旋翼飞行器***的输入少于输出,是一个典型的欠驱动***,因此不可能对六个自由度同时进行追踪;一个合理的控制方案为跟踪航迹(xd,yd,zd)和滚转角φd,中间指令信号θd,ψd需要根据位置模型进行求解,并传递给姿态模型,完成姿态和位置的全局控制。
优选的,作为一种固定时间滑模控制方法,步骤四中,选择指数形式的非奇异终端滑模函数,使最终构造的控制器满足固定时间内***状态跟踪误差为0;传统的非奇异滑模控制方法中,***将在有限时间到达滑模面,但无法控制收敛速度的快慢,收敛时间受初始状态影响;按照固定时间理论构造非奇异终端滑模函数,不仅能跟踪***状态,还可以计算出状态跟踪误差变为0的时间上界,该时间上界仅和设计参数有关,与初始状态无关,提升了***控制的及时性和可靠性。
优选的,作为一种控制策略,在步骤五中采用步骤四提出的基于固定时间理论构造的非奇异终端滑模函数进行控制器设计,并在控制器中加入了非线性函数μi(x),避免了奇异问题的出现。
实施例1:步骤六.仿真实验,具体包括:
S601.利用MATLAB仿真环境中的simulink模块进行建立四旋翼飞行器动力学模型,所述四旋翼飞行器设定参数为见表1:
表1:四旋翼飞行器参数设置
S602.在MATLAB仿真环境中进行控制器设计,控制器参数为:外部扰动值di=0.2sin(i·t),i=1,...6;位置滑模面系数选取为ai=5,bi=2,其中i=1,2,3;姿态滑模面系数选取为/>ai=15,bi=10,其中i=4,5,6;控制增益为k=1,时间常数为τ=0.1;
S603.设置四旋翼的初始位置为[x,y,z]T=[0,0,0]T(m),初始姿态角度为[θ,ψ,φ]T=[0,0,0]T(rad);期望位置指令设置为pd=[0.5cos(0.5t),0.5sin(0.5t),0.1t]T,期望滚转角选取φd=π/3;
S604.根据设定参数计算收敛时间上界,其中姿态收敛时间上界为Tin=3.1944s,位置环收敛时间上界Tout=8.0255s。
仿真中同时给出了实际轨迹和参考轨迹,从图2跟踪曲线能够看出,在有干扰情况下所设计的固定时间终端滑模控制器工作稳定,且具有良好的鲁棒性,能够很好的执行三维空间轨迹跟踪的任务;同时,为了更直观地显示出良好的跟踪效果,图3分别展示了飞行器在x,y,z三个方向的跟踪情况;三个姿态变量θ,ψ,φ的跟踪效果曲线如图4所示;由图可知滚转角φ能够在很短时间内跟踪上期望值,并且在飞行过程中,俯仰角θ和偏航角ψ保持稳定,与期望控制效果相符合;
图5为位置跟踪误差变化曲线,x轴、y轴、z轴三个方向的跟踪误差均可很快收敛到零,调节时间短,为5s左右,小于位置收敛时间上界Tout=8.0255s;图6给出了三个姿态变量的跟踪误差曲线,从局部放大图中能够清晰的看到误差收敛的调节时间极短,约为1s,小于内环收敛时间上界Tin=3.1944s,进一步验证了控制设计的有效性;图4和图6为位置的控制输入量,0-5s控制器调节效果明显,5s之后,由于位置状态的跟踪误差收敛为零,控制律曲线趋于稳定,且整个调节过程没有明显抖振现象。姿态子***控制曲线如图4和图7,可以看出控制器0-1s作用显著,与姿态跟踪误差收敛时间相对应,控制效果良好;
证明了本发明所述基于终端滑模控制的固定时间四旋翼飞行器控制方法具有好的较好的收敛速度和跟踪能力、快速性和鲁棒性好的优点。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (1)
1.一种基于终端滑模控制的固定时间四旋翼飞行器控制方法,其特征在于:包括
步骤一:首先建立基于拉格朗日方程的四旋翼飞行器的非线性动力学模型;
步骤一所述的基于拉格朗日方程的四旋翼飞行器的非线性动力学模型为:
其中:飞行器的三个姿态的欧拉角度表示为Ω=[θ,ψ,φ]T,分别代表滚转角、俯仰角和偏航角;角速度表示为飞行器质心在惯性坐标系中的位置坐标表示为p=[x,y,z]T;速度表示为/>飞行器半径长度l表示每个旋翼末端到飞行器重心的距离;m代表四旋翼飞行器的负载总重量;Ii代表围绕每个轴的转动惯量;Ki为阻力系数;di为扰动,并假设时变扰动di,i=1,...,6有界且上界已知,即存在正实数λ,使得|di|≤λ,所有扰动均有界;
将飞行器每个旋翼产生的推力用Fi表示,ui为虚拟控制输入,i=1,2,3,4,定义如下:
其中:R代表比例系数;
步骤二:将四旋翼飞行器非线性动力学模型转化为包括位置***和姿态***的二阶非线性***形式;
步骤二所述的将四旋翼飞行器非线性动力学模型转化为包括位置***和姿态***的二阶非线性***形式的过程具体包括:
S201.首先,设待设计的虚拟控制输入为:
则式(1)中用来描述姿态状态的四旋翼动力学模型变为:
S202.令up=[u1x,u1y,u1z]T,fp=-[0,0,g]T-diag([K1/m,K2/m,K3/m])·v,令p=[x,y,z]T表示三维位置,v表示速度,则式(1)中的四旋翼飞行器位置模型可以写成如下二阶非线性***形式:
S203.同理,令uo=[u2,u3,u4]T,fo=-diag[lK4/I1,lK5/I2,lK6/I3]·ω,do=[d4,d5,d6]T,则式(4)四旋翼飞行器姿态模型可以写成如下二阶非线性***形式:
S204.设 则四旋翼飞行器***可以转化为如下二阶***形式:
步骤三:基于四旋翼飞行器欠驱动的特点,求解位置模型的中间指令信号θd,ψd;
步骤三所述的基于四旋翼飞行器欠驱动的特点,求解位置模型的中间指令信号θd,ψd的求解过程包括:
S301.由四旋翼飞行器的控制输入可得:
S302.由于则式(8)变为:
S303.由于u1z=u1cosφcosψd,可得则式(9)变为:
S304.再由式(10)可得:
S305.此时,根据式(11)可以求解出ψd和θd为:
步骤S305所述的θd的虚拟参考指令为
其中:
步骤四:根据步骤二和步骤三的模型处理结果,设计基于固定时间理论的非奇异终端滑模函数;
步骤四所述的设计基于固定时间理论的非奇异终端滑模函数的具体过程包括:
S401.针对二阶非线性***
设x=0时为***的平衡状态,若存在连续的径向无界的函数V:R→R+∪{0},使且***的任意解x(t)满足式
在式(14)中:a、b、p、q、k均为正数且满足pk<1,qk>1,则***的零平衡状态是全局固定时间稳定的,并且解决时间上限T满足下列不等式:
S402.设跟踪误差根据固定时间理论构造下列非奇异终端滑模面为:
在式(16)中,ai>0,bi>0,pj i,qj i均为正奇数,j=1,2,3,且有
步骤五:以步骤四非奇异终端滑模函数为控制策略,设计非奇异终端滑模固定时间控制器,使***位置及姿态轨迹跟踪误差在固定时间收敛到零;
步骤五所述的非奇异终端滑模固定时间控制器的设计过程包括:
在式(17)中,k=2λ,非线性函数μi定义如下:
在式(18)中,当x→0时,非线性函数μi(x)/x→0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110270909.9A CN113050683B (zh) | 2021-03-12 | 2021-03-12 | 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110270909.9A CN113050683B (zh) | 2021-03-12 | 2021-03-12 | 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113050683A CN113050683A (zh) | 2021-06-29 |
CN113050683B true CN113050683B (zh) | 2023-09-22 |
Family
ID=76512084
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110270909.9A Active CN113050683B (zh) | 2021-03-12 | 2021-03-12 | 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113050683B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117991830B (zh) * | 2024-04-03 | 2024-06-21 | 天目山实验室 | 一种提高二阶非奇异终端滑模控制收敛速度的方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007035559A2 (en) * | 2005-09-19 | 2007-03-29 | Cleveland State University | Controllers, observers, and applications thereof |
CN107479567A (zh) * | 2017-09-13 | 2017-12-15 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
CN107479371A (zh) * | 2017-07-03 | 2017-12-15 | 浙江工业大学 | 一种基于快速非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 |
WO2018023201A1 (zh) * | 2016-08-03 | 2018-02-08 | 孟强 | 一种自适应终端滑模控制方法 |
CN108153148A (zh) * | 2017-07-03 | 2018-06-12 | 浙江工业大学 | 一种四旋翼无人机***的增强型指数趋近律滑模控制方法 |
CN108563125A (zh) * | 2018-05-28 | 2018-09-21 | 浙江工业大学 | 基于指数增强型幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法 |
CN110502027A (zh) * | 2019-09-16 | 2019-11-26 | 南京邮电大学 | 一种基于自适应终端滑模的四旋翼无人机姿态容错控制方法 |
CN111258216A (zh) * | 2018-11-30 | 2020-06-09 | 浙江工业大学 | 一种适用于四旋翼飞行器的滑模重复控制器 |
CN111722634A (zh) * | 2020-05-28 | 2020-09-29 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9715234B2 (en) * | 2015-11-30 | 2017-07-25 | Metal Industries Research & Development Centre | Multiple rotors aircraft and control method |
-
2021
- 2021-03-12 CN CN202110270909.9A patent/CN113050683B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007035559A2 (en) * | 2005-09-19 | 2007-03-29 | Cleveland State University | Controllers, observers, and applications thereof |
WO2018023201A1 (zh) * | 2016-08-03 | 2018-02-08 | 孟强 | 一种自适应终端滑模控制方法 |
CN107479371A (zh) * | 2017-07-03 | 2017-12-15 | 浙江工业大学 | 一种基于快速非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 |
CN108153148A (zh) * | 2017-07-03 | 2018-06-12 | 浙江工业大学 | 一种四旋翼无人机***的增强型指数趋近律滑模控制方法 |
CN107479567A (zh) * | 2017-09-13 | 2017-12-15 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
CN108563125A (zh) * | 2018-05-28 | 2018-09-21 | 浙江工业大学 | 基于指数增强型幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法 |
CN111258216A (zh) * | 2018-11-30 | 2020-06-09 | 浙江工业大学 | 一种适用于四旋翼飞行器的滑模重复控制器 |
CN110502027A (zh) * | 2019-09-16 | 2019-11-26 | 南京邮电大学 | 一种基于自适应终端滑模的四旋翼无人机姿态容错控制方法 |
CN111722634A (zh) * | 2020-05-28 | 2020-09-29 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
Non-Patent Citations (7)
Title |
---|
A robust global fast terminal sliding mode controller for quadrotor helicopters;Jiaxin Yuan,et al.;《2017 IEEE 8th International Conference on CIS & RAM》;20180201;第2106-2110页 * |
Leader-Follower Formation Control of Multiple Quadrotors;Z. Zhao, et al.;《2018 IEEE CSAA Guidance, Navigation and Control Conference (CGNCC) 》;20180812;第1-6页 * |
Nonlinear Feedback Design for Fixed-Time Stabilization of Linear Control Systems;Andrey Polyakov,et al.;《IEEE TRANSACTIONS ON AUTOMATIC CONTROL》;20111214;第57卷(第8期);第54-57页 * |
Robust adaptive nonsingular fast terminal sliding-mode tracking control for an uncertain quadrotor UAV subjected to disturbances;Moussa Labbadi, et al.;《ISA Transactions》;20200430;第99卷;第290-304页 * |
一类非线性***的新型固定时间滑模控制;王崇 等;《电光与控制》;20190621;第27卷(第01期);第47-53+59页 * |
可穿戴五自由度上肢外骨骼机器人固定时间控制;张高巍 等;《控制理论与应用》;20200131;第37卷(第01期);第205-214页 * |
可重复使用运载火箭一子级垂直回收有限时间滑模控制;李晓栋等;中南大学学报(自然科学版)(第04期);第123-132页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113050683A (zh) | 2021-06-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
CN109613931B (zh) | 基于生物社会力的异构无人机集群目标跟踪***及方法 | |
CN105676641B (zh) | 基于反步和滑模控制的非线性鲁棒控制器的设计方法 | |
CN107390706B (zh) | 一种基于预演机动规则***的无人机近距格斗决策方法 | |
Herissé et al. | Landing a VTOL unmanned aerial vehicle on a moving platform using optical flow | |
CN108181920B (zh) | 基于给定时间的四旋翼无人机高精度姿态跟踪控制方法 | |
Yu et al. | Attitude tracking control of a quadrotor UAV in the exponential coordinates | |
CN106707749B (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
Wang et al. | Nonlinear aeroelastic control of very flexible aircraft using model updating | |
CN113268064A (zh) | 一种考虑通信时延的多移动机器人协同编队控制方法 | |
CN111443721A (zh) | 一种四旋翼无人机姿态动态面控制方法及存储介质 | |
Yeh | Attitude controller design of mini-unmanned aerial vehicles using fuzzy sliding-mode control degraded by white noise interference | |
CN113050683B (zh) | 一种基于终端滑模控制的固定时间四旋翼飞行器控制方法 | |
CN115639830A (zh) | 一种空地智能体协同编队控制***及其编队控制方法 | |
Chen et al. | Image based fixed time visual servoing control for the quadrotor UAV | |
Nian et al. | 2-D path following for fixed wing UAV using global fast terminal sliding mode control | |
CN115129072A (zh) | 固定翼无人机位置跟踪偏差约束下终端滑模控制方法 | |
Stebler et al. | Dynamic neural network-based sliding mode estimation of quadrotor systems | |
Ma et al. | A joint guidance and control framework for autonomous obstacle avoidance in quadrotor formations under model uncertainty | |
Xue et al. | A Moving Target Tracking Control of Quadrotor UAV Based on Passive Control and Super‐Twisting Sliding Mode Control | |
Li et al. | Adaptive neural network-based fault-tolerant control for quadrotor-slung-load system under marine scene | |
Dydek | Adaptive control of unmanned aerial systems | |
Oliveira et al. | Ground target tracking for unmanned aerial vehicles | |
CN114019997B (zh) | 固定翼无人机位置跟踪偏差约束下有限时间控制方法 | |
McIntosh et al. | An Aerodynamic Feedforward-Feedback Architecture for Tailsitter Control in Hybrid Flight Regimes |
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 |