CN109358504B - 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 - Google Patents
基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 Download PDFInfo
- Publication number
- CN109358504B CN109358504B CN201811246308.9A CN201811246308A CN109358504B CN 109358504 B CN109358504 B CN 109358504B CN 201811246308 A CN201811246308 A CN 201811246308A CN 109358504 B CN109358504 B CN 109358504B
- Authority
- CN
- China
- Prior art keywords
- rotor
- attitude
- interference
- tracking
- adaptive
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
本发明公开了一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法。针对四旋翼飞行器空间飞行控制过程中存在的未知质量、三轴转动惯量引起的参数不确定性和加性外部干扰,采用自适应与积分鲁棒复合的抗干扰控制方法实现对四旋翼轨迹/姿态的精准跟踪:首先,建立考虑参数不确定性和外部干扰的四旋翼运动/动力学矢量化模型;其次,将上述模型分解为可描述三通道位置、速度、姿态、角速率变化的标量模型;然后,根据上述标量模型,构造基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器;最后,根据姿态回路的标量模型以及由位置回路控制器解算生成的期望姿态角指令,构造基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器。
Description
技术领域
本发明涉及导航制导方向的四旋翼轨迹/姿态跟踪领域,具体为一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法,主要应用于解决考虑质量、三轴转动惯量等参数不确定性和外部干扰并存情况下的四旋翼轨迹/姿态精准跟踪控制问题。
背景技术
近年来,四旋翼飞行器因操控性方便、扩展性强、运动敏捷性高、可垂直起降等优异性能受到国内外研究学者的广泛关注。相对于固定翼飞机,四旋翼飞行器具有体积小、质量轻、造价低等优点,被广泛应用于侦查、追踪、灾害救援、影像拍摄等场合。飞行控制系统作为四旋翼的“神经中枢”,是保证四旋翼稳定、精准飞行,完成飞行任务的前提。然而,四旋翼自身的运动/动力学模型具有欠驱动、强耦合、非线性的特性,并且四旋翼飞行过程中极易受到外界随机干扰的影响。此外,随着四旋翼飞行任务向多样化、复杂化和精细化方向发展,对闭环系统稳定性、暂态性能、稳态精度以及抗干扰能力提出了更为苛刻的要求。以比例-积分-微分(PID)、线性反馈化为代表的常规控制方法已经难以适用,亟需开展适应四旋翼典型模型特征以及具备强抗扰能力的飞行控制方法研究。
参数不确定性和外部干扰是影响四旋翼飞行器轨迹/姿态控制品质的关键因素。具体而言,受限于缺少精密测量仪器,四旋翼的三轴转动惯量参数难以获取,四旋翼外设的变化往往导致飞行过程中飞行器质量发生变化,上述质量和转动惯量测量难题造成了四旋翼的参数不确定性问题,而外部干扰主要指大气风场引起的未知干扰力矩。若在控制器设计过程中对上述干扰的影响不加以考虑,将会导致四旋翼飞控性能急剧恶化、甚至失稳,难以保证飞行安全。现有用于四旋翼飞行器的抗干扰控制方法仅仅考虑了外部风扰和气动参数不确定性,对于严重影响飞行品质的转动惯量等参数不确定性缺乏重要关注。此外,已有研究大多将外部干扰和参数不确定性视为有界集总扰动,采用自适应估计或者干扰观测器对上述干扰作用进行观测并补偿,最后与滑模或动态面控制器综合,以应对未知干扰的不利影响。不难发现,已有研究中并未对施加的干扰进行分离与分类,仅采用单一的抗干扰机制(如干扰补偿或参数估计)处理未知外界扰动和不确定性,控制效果具有较大保守性,控制性能存在鲁棒性不足的缺陷。因此针对上述控制方法中的多种缺陷,需要提供一种综合考虑并克服多种缺陷的复合抗干扰控制方法。
发明内容
本发明针对四旋翼空间飞行过程中广泛存在的质量、转动惯量等参数不确定性和外部干扰,通过有效复合参数辨识和干扰抑制两种抗干扰措施,提出了一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰控制方法。
本发明是通过如下技术方案来实现的:一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法,包括以下步骤:
(1)建立考虑参数不确定性和外部干扰的四旋翼运动/动力学矢量化模型,四旋翼运动/动力学矢量化模型为:
其中,X1=[X11,X12,X13]T、X2=[X21,X22,X23]T为四旋翼在惯性坐标系下的位置矢量和速度矢量;m为四旋翼的质量;Π1=diag(kx,ky,kz)∈R3×3为空气动力阻尼矩阵,ki(i=x,y,z)为气动阻尼系数;F=g1u1-G,u1为四旋翼四个螺旋桨产生的升力之和,g1=[c(ψ)s(θ)c(φ)+s(ψ)s(φ),s(ψ)s(θ)c(φ)-c(ψ)s(φ),c(θ)c(φ)]T表示和姿态角相关的位置回路输入矩阵,s(·)、c(·)此处表示sin(·)、cos(·),G=[0,0,mg]T;X3=[X31,X32,X33]T、X4=[X41,X42,X43]T为四旋翼在机体坐标系下的姿态角矢量和姿态角速率矢量;J=[J1,J2,J3]T,Ji(i=1,2,3)表示四旋翼在机体坐标系下关于x,y,z轴的转动惯量;Π2=diag(kφ,kθ,kψ)∈R3×3为空气动力阻尼矩阵,kj(j=φ,θ,ψ)为气动阻尼系数;g2=diag(l,l,c)∈R3×3,其中,l为四旋翼机体中心到螺旋桨轴心的距离,c为力矩因子;τ=[τ1,τ2,τ3]T表示四旋翼在机体坐标系下沿x,y,z轴的输入力矩;d2(t)=[d21(t),d22(t),d23(t)]T,d4(t)=[d41(t),d42(t),d43(t)]T分别为四旋翼位置和姿态回路的外部干扰。
(2)上述矢量化模型分解为可描述三通道位置、速度、姿态、角速率变化的标量模型,将步骤(1)中四旋翼运动/动力学矢量化模型分解为步骤(2)中可描述三通道位置、速度、姿态、角速率变化的标量模型:
其中,X1i(i=1,2,3)、X2i(i=1,2,3)分别为X1、X2中的第i个元素;ki为Π1中对应的对角线元素,fi(i=1,2,3)为F=[f1,f2,f3]T中的第i个元素;X3i(i=1,2,3)、X4i(i=1,2,3)分别为X3、X4中的第i个元素;Ji(i=1,2,3)为J中第i个对角线元素,kj为Π2中对应的对角线元素;τi(i=1,2,3)为τ中的第i个元素,g2i(i=1,2,3)为g2中的第i个对角线元素;d2i(t)(i=1,2,3)、d4i(t)(i=1,2,3)分别为d2(t)、d4(t)中的第i个元素。
(3)根据位置回路的标量模型,构造基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器,为后续姿态控制器设计提供必要的参考指令,其中,采用自适应律对未知质量进行参数估计,通过具有非线性反馈功能的积分鲁棒控制器对外部干扰进行充分抑制,实现对于给定轨迹信号的精确跟踪;
依据步骤(2)中的四旋翼标量模型构造步骤(3)中所述的基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器:
设计四旋翼轨迹跟踪控制器,首先定义如下的位置回路误差变量:
其中,e1=[e11,e12,e13]T为四旋翼位置跟踪误差,X1d=[X11d,X12d,X13d]T为四旋翼在惯性坐标系下的位置参考指令,e2=[e21,e22,e23]T为四旋翼速度跟踪误差,k1、k2为正的反馈增益;r1=[r11,r12,r13]T表示为提高控制器的设计自由度所定义的误差;由上述误差变量,可得如下的基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器:
其中,为四旋翼质量的估计值,X1id(i=1,2,3)为X1d中的第i个元素;kr1、k2、β1为正的反馈增益,sign(e2i)在此处表示符号函数;e2i(i=1,2,3)为e2中的第i个元素;Γ11为自适应律参数,r11为r1中的第1个元素,为估计四旋翼质量的参数自适应律:
上述控制器中,fi分为fia和fis两部分:fia为基于参数自适应的模型前馈补偿项:一方面,通过自适应律对不确定质量进行在线辨识,以消除质量不确定性对闭环系统的影响;另一方面,利用位置回路模型辅助信息并以前馈方式嵌入控制项中,可解决位置回路中的非线性模型补偿问题;fis为积分鲁棒项,通过积分鲁棒线性反馈和非线性反馈,抑制未知的外界扰动,提高系统的鲁棒性;最后将自适应律和积分鲁棒两种控制方法复合,实现四旋翼轨迹精准跟踪控制;
由上述控制器F=[f1,f2,f3]T可推得期望姿态角指令,F与期望姿态角指令的关系如下:
由公式(6)逆变换出如下公式:
上式中,X3d=[φd,θd,ψd]T为四旋翼期望的姿态角指令。
(4)根据姿态回路的标量模型,结合步骤(3)生成的期望姿态角指令,综合自适应律对三通道转动惯量的精确辨识能力与积分鲁棒对外部干扰的强鲁棒抗干扰能力,构造基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器,实现对于给定姿态指令的稳定跟踪:设计四旋翼姿态跟踪控制器,首先定义如下的姿态回路误差变量:
其中,e3=[e31,e32,e33]T为四旋翼姿态跟踪误差,e4=[e41,e42,e43]T为四旋翼姿态角速率跟踪误差,k3、k4为正的反馈增益;r2=[r21,r22,r23]T表示为提高控制器的设计自由度所定义的误差;由上述误差变量,可得如下的基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器:
其中,为四旋翼转动惯量Ji的估计值,X3id(i=1,2,3)为X3d中的第i个元素;kr2、k4、β2为正的反馈增益,sign(e4i)在此处表示符号函数,e4i(i=1,2,3)为e4中的第i个元素;Γ2i为自适应律对角矩阵Γ2=diag(Γ21,Γ22,Γ23)中第i个对角线元素;r2i为r2中的第i个元素;为估计四旋翼三轴转动惯量的参数自适应律:
在上述控制器中,τi分为τia和τis两部分:τia为基于参数自适应的模型前馈补偿项:一方面,通过自适应律对三轴转动惯量进行在线估计,以消除三轴转动惯量不确定性对闭环系统的影响;另一方面,利用姿态回路模型辅助信息并以前馈方式嵌入至控制项中,解决姿态回路中的非线性模型补偿问题;τis为积分鲁棒项,通过积分鲁棒线性反馈和非线性反馈,抑制未知的外界扰动,提高系统的鲁棒性;最后将自适应律和积分鲁棒两种控制方法复合,实现四旋翼姿态精准跟踪控制。
本发明主要是针对四旋翼飞行器空间飞行控制过程中广泛存在的未知质量、三轴转动惯量引起的参数不确定性和加性外部干扰,利用一种将自适应与积分鲁棒复合的抗干扰控制方法实现对四旋翼轨迹/姿态的精准跟踪:首先,建立考虑参数不确定性和外部干扰的四旋翼运动/动力学矢量化模型;其次,将矢量化模型分解为可描述三通道位置、速度、姿态、角速率变化的标量模型;然后,根据位置回路的标量模型,构造基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器;最后,根据姿态回路的标量模型以及由位置回路控制器解算生成的期望姿态角指令,构造基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器。
与现有技术相比本发明具有以下有益效果:本发明提供的一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰控制方法,其创新之处在于利用自适应参数估计将参数不确定性的抗干扰问题转化为参数辨识问题,借助积分鲁棒的非线性鲁棒反馈项提升控制器对于外部干扰的鲁棒性,该复合抗干扰控制器由于充分考虑了干扰的不同特性,可大大降低抗干扰控制器设计的保守性,显著提升四旋翼对于未知干扰和参数不确定性的抗干扰能力,可实现对于给定轨迹/姿态的高精度跟踪控制。
附图说明
图1为自适应积分鲁棒复合抗干扰控制方法的流程图。
图2为自适应积分鲁棒复合抗干扰控制方法作用下四旋翼位置跟踪效果。
图3为自适应积分鲁棒复合抗干扰控制方法作用下四旋翼姿态跟踪效果。
图4为自适应更新律作用下四旋翼质量、三轴转动惯量的在线估计过程。
具体实施方式
以下结合具体实施例和附图对本发明作进一步说明。
一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法,如图1所示,包括以下步骤:
(1)建立考虑参数不确定性和外部干扰的四旋翼运动/动力学矢量化模型,四旋翼运动/动力学矢量化模型为:
其中,X1=[X11,X12,X13]T、X2=[X21,X22,X23]T为四旋翼在惯性坐标系下的位置矢量和速度矢量;X1,X2的初始取值为X1=[0,0,0]Tm,X2=[0,0,0]Tm/s,m为四旋翼的质量;Π1=diag(kx,ky,kz)∈R3×3为空气动力阻尼矩阵,ki(i=x,y,z)为气动阻尼系数;F=g1u1-G,u1为四旋翼四个螺旋桨产生的升力之和,g1=[c(ψ)s(θ)c(φ)+s(ψ)s(φ),s(ψ)s(θ)c(φ)-c(ψ)s(φ),c(θ)c(φ)]T表示和姿态角相关的位置回路输入矩阵,s(·)、c(·)此处表示sin(·)、cos(·),G=[0,0,mg]T;X3=[X31,X32,X33]T、X4=[X41,X42,X43]T为四旋翼在机体坐标系下的姿态角矢量和姿态角速率矢量,X3,X4的初始取值为X3=[0,0,0]Tdeg,X4=[0,0,0]Tdeg/sec;J=[J1,J2,J3]T,Ji(i=1,2,3)表示四旋翼在机体坐标系下关于x,y,z轴的转动惯量;Π2=diag(kφ,kθ,kψ)∈R3×3为空气动力阻尼矩阵,kj(j=φ,θ,ψ)为气动阻尼系数;g2=diag(l,l,c)∈R3×3,其中,l为四旋翼机体中心到螺旋桨轴心的距离,c为力矩因子;τ=[τ1,τ2,τ3]T表示四旋翼在机体坐标系下沿x,y,z轴的输入力矩;d2(t)=[d21(t),d22(t),d23(t)]T,d4(t)=[d41(t),d42(t),d43(t)]T分别为四旋翼位置和姿态回路的外部干扰。
上述四旋翼运动/动力学模型中具体参数和所考虑的外部干扰如下表所示:
表1参数与外部干扰
(2)上述矢量化模型分解为可描述三通道位置、速度、姿态、角速率变化的标量模型,将步骤(1)中四旋翼运动/动力学矢量化模型分解为步骤(2)中可描述三通道位置、速度、姿态、角速率变化的标量模型:
其中,X1i(i=1,2,3)、X2i(i=1,2,3)分别为X1、X2中的第i个元素;ki为Π1中对应的对角线元素,fi(i=1,2,3)为F=[f1,f2,f3]T中的第i个元素;X3i(i=1,2,3)、X4i(i=1,2,3)分别为X3、X4中的第i个元素;Ji(i=1,2,3)为J中第i个对角线元素,kj为Π2中对应的对角线元素;τi(i=1,2,3)为τ中的第i个元素,g2i(i=1,2,3)为g2中的第i个对角线元素;d2i(t)(i=1,2,3)、d4i(t)(i=1,2,3)分别为d2(t)、d4(t)中的第i个元素。
(3)根据位置回路的标量模型,构造基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器,为后续姿态控制器设计提供必要的参考指令,其中,采用自适应律对未知质量进行参数估计,通过具有非线性反馈功能的积分鲁棒控制器对外部干扰进行充分抑制,实现对于给定轨迹信号的精确跟踪;
依据步骤(2)中的四旋翼标量模型构造步骤(3)中所述的基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器:
设计四旋翼轨迹跟踪控制器,首先定义如下的位置回路误差变量:
其中,e1=[e11,e12,e13]T为四旋翼位置跟踪误差,X1d=[X11d,X12d,X13d]T为四旋翼在惯性坐标系下的位置参考指令,初值取X1d=[cos(t+2)-cos(2),sin(t+2.4)-sin(2.4),t]T,e2=[e21,e22,e23]T为四旋翼速度跟踪误差,k1、k2为正的反馈增益;r1=[r11,r12,r13]T表示为提高控制器的设计自由度所定义的误差;由上述误差变量,可得如下的基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器:
其中,为四旋翼质量的估计值(由于四旋翼质量为标量,我们此处仅需要选取X11d进行质量自适应估计),X1id(i=1,2,3)为X1d中的第i个元素;kr1、k2、β1为正的反馈增益,sign(e2i)在此处表示符号函数;e2i(i=1,2,3)为e2中的第i个元素;Γ11为自适应律参数,r11为r1中的第1个元素,为估计四旋翼质量的参数自适应律:
上述控制器中,fi分为fia和fis两部分:fia为基于参数自适应的模型前馈补偿项;fis为积分鲁棒项;最后将自适应律和积分鲁棒两种控制方法复合,实现四旋翼轨迹精准跟踪控制;
由上述控制器F=[f1,f2,f3]T可推得期望姿态角指令,F与期望姿态角指令的关系如下:
由公式(6)逆变换出如下公式:
上式中,X3d=[φd,θd,ψd]T为四旋翼期望的姿态角指令。
(4)根据姿态回路的标量模型,结合步骤(3)生成的期望姿态角指令,综合自适应律对三通道转动惯量的精确辨识能力与积分鲁棒对外部干扰的强鲁棒抗干扰能力,构造基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器,实现对于给定姿态指令的稳定跟踪:设计四旋翼姿态跟踪控制器,首先定义如下的姿态回路误差变量:
其中,e3=[e31,e32,e33]T为四旋翼姿态跟踪误差,e4=[e41,e42,e43]T为四旋翼姿态角速率跟踪误差,k3、k4为正的反馈增益;r2=[r21,r22,r23]T表示为提高控制器的设计自由度所定义的误差;由上述误差变量,可得如下的基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器:
其中,为四旋翼转动惯量Ji的估计值,X3id(i=1,2,3)为X3d中的第i个元素;kr2、k4、β2为正的反馈增益,sign(e4i)在此处表示符号函数,e4i(i=1,2,3)为e4中的第i个元素;Γ2i为自适应律对角矩阵Γ2=diag(Γ21,Γ22,Γ23)中第i个对角线元素;r2i为r2中的第i个元素;为估计四旋翼三轴转动惯量的参数自适应律:
在上述控制器中,τi分为τia和τis两部分:τia为基于参数自适应的模型前馈补偿项;τis为积分鲁棒项;最后将自适应律和积分鲁棒两种控制方法复合,实现四旋翼姿态精准跟踪控制。
上述轨迹跟踪控制器和姿态跟踪控制器中的相关参数设计如下:
表2轨迹跟踪控制器和姿态跟踪控制器中的相关参数设计
自适应积分鲁棒复合抗干扰控制方法作用下四旋翼位置跟踪效果如图2所示。由图2可以看出,即使位置回路存在质量不确定性和附加扰动,三轴轨迹跟踪误差依然可以渐近收敛于零域的小范围内,较好实现了对于给定轨迹参考指令的跟踪控制。
自适应积分鲁棒复合抗干扰控制方法作用下四旋翼姿态跟踪效果如图3所示。不难发现,四旋翼姿态输出可以精确地跟踪相应的期望信号,姿态跟踪误差均稳定维持在零域的小偏差范围内。
自适应更新律作用下四旋翼质量、三轴转动惯量的在线估计过程如图4所示。由图4可以看出,质量、转动惯量的估计值可以快速逼近相应的参数真值,确保了所提控制方法对于参数不确定性的良好辨识能力。
综上,本实施例通过复合自适应更新律对参数不确定性的优异辨识能力与积分鲁棒对于外部干扰的强抑制能力,所提供的抗干扰控制方法可以实现参数不确定性和外部干扰并存情况下的四旋翼轨迹/姿态高精度跟踪控制。
本发明要求保护的范围不限于以上具体实施方式,而且对于本领域技术人员而言,本发明可以有多种变形和更改,凡在本发明的构思与原则之内所作的任何修改、改进和等同替换都应包含在本发明的保护范围之内。
Claims (1)
1.一种基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法,其特征在于:包括以下步骤:
(1)建立考虑参数不确定性和外部干扰的四旋翼运动/动力学矢量化模型,四旋翼运动/动力学矢量化模型为:
其中,X1=[X11,X12,X13]T、X2=[X21,X22,X23]T为四旋翼在惯性坐标系下的位置矢量和速度矢量;m为四旋翼的质量;Π1=diag(kx,ky,kz)∈R3×3为空气动力阻尼矩阵,ki(i=x,y,z)为气动阻尼系数;F=g1u1-G,u1为四旋翼四个螺旋桨产生的升力之和,g1=[c(ψ)s(θ)c(φ)+s(ψ)s(φ),s(ψ)s(θ)c(φ)-c(ψ)s(φ),c(θ)c(φ)]T表示和姿态角相关的位置回路输入矩阵,s(·)、c(·)此处表示sin(·)、cos(·),G=[0,0,mg]T;X3=[X31,X32,X33]T、X4=[X41,X42,X43]T为四旋翼在机体坐标系下的姿态角矢量和姿态角速率矢量;J=[J1,J2,J3]T,Ji(i=1,2,3)表示四旋翼在机体坐标系下关于x,y,z轴的转动惯量;Π2=diag(kφ,kθ,kψ)∈R3×3为空气动力阻尼矩阵,kj(j=φ,θ,ψ)为气动阻尼系数;g2=diag(l,l,c)∈R3×3,其中,l为四旋翼机体中心到螺旋桨轴心的距离,c为力矩因子;τ=[τ1,τ2,τ3]T表示四旋翼在机体坐标系下沿x,y,z轴的输入力矩;d2(t)=[d21(t),d22(t),d23(t)]T,d4(t)=[d41(t),d42(t),d43(t)]T分别为四旋翼位置和姿态回路的外部干扰;
(2)步骤(1)中的矢量化模型分解为可描述三通道位置、速度、姿态、角速率变化的标量模型:
其中,X1i(i=1,2,3)、X2i(i=1,2,3)分别为X1、X2中的第i个元素;ki为Π1中对应的对角线元素,fi(i=1,2,3)为F=[f1,f2,f3]T中的第i个元素;X3i(i=1,2,3)、X4i(i=1,2,3)分别为X3、X4中的第i个元素;Ji(i=1,2,3)为J中第i个对角线元素,kj为Π2中对应的对角线元素;τi(i=1,2,3)为τ中的第i个元素,g2i(i=1,2,3)为g2中的第i个对角线元素;d2i(t)(i=1,2,3)、d4i(t)(i=1,2,3)分别为d2(t)、d4(t)中的第i个元素;
(3)根据位置回路的标量模型,构造基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器,为后续姿态控制器设计提供参考指令,其中,采用自适应律对未知质量进行参数估计,通过具有非线性反馈功能的积分鲁棒控制器对外部干扰进行充分抑制,实现对于给定轨迹信号的精确跟踪,具体如下:
设计四旋翼轨迹跟踪控制器,首先定义如下的位置回路误差变量:
其中,e1=[e11,e12,e13]T为四旋翼位置跟踪误差,X1d=[X11d,X12d,X13d]T为四旋翼在惯性坐标系下的位置参考指令,e2=[e21,e22,e23]T为四旋翼速度跟踪误差,k1、k2为正的反馈增益;r1=[r11,r12,r13]T表示为提高控制器的设计自由度所定义的误差;由上述误差变量,可得如下的基于自适应积分鲁棒的四旋翼轨迹复合抗干扰跟踪控制器:
其中,为四旋翼质量的估计值,X1id(i=1,2,3)为X1d中的第i个元素;kr1、k2、β1为正的反馈增益,sign(e2i)在此处表示符号函数;e2i(i=1,2,3)为e2中的第i个元素;Γ11为自适应律参数,r11为r1中的第1个元素,为估计四旋翼质量的参数自适应律:
上述控制器中,fi分为fia和fis两部分:fia为基于参数自适应的模型前馈补偿项;fis为积分鲁棒项;最后将自适应律和积分鲁棒两种控制方法复合,实现四旋翼轨迹精准跟踪控制;
由上述控制器F=[f1,f2,f3]T可推得期望姿态角指令,F与期望姿态角指令的关系如下:
由公式(6)逆变换出如下公式:
上式中,X3d=[φd,θd,ψd]T为四旋翼期望的姿态角指令;
(4)根据姿态回路的标量模型,结合步骤(3)生成的期望姿态角指令,综合自适应律对三通道转动惯量的精确辨识能力与积分鲁棒对外部干扰的强鲁棒抗干扰能力,构造基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器,实现对于给定姿态指令的稳定跟踪,具体如下:
设计四旋翼姿态跟踪控制器,首先定义如下的姿态回路误差变量:
其中,e3=[e31,e32,e33]T为四旋翼姿态跟踪误差,e4=[e41,e42,e43]T为四旋翼姿态角速率跟踪误差,k3、k4为正的反馈增益;r2=[r21,r22,r23]T表示为提高控制器的设计自由度所定义的误差;由上述误差变量,可得如下的基于自适应积分鲁棒的四旋翼姿态复合抗干扰跟踪控制器:
其中,为四旋翼转动惯量Ji的估计值,X3id(i=1,2,3)为X3d中的第i个元素;kr2、k4、β2为正的反馈增益,sign(e4i)在此处表示符号函数,e4i(i=1,2,3)为e4中的第i个元素;Γ2i为自适应律对角矩阵Γ2=diag(Γ21,Γ22,Γ23)中第i个对角线元素;r2i为r2中的第i个元素;为估计四旋翼三轴转动惯量的参数自适应律:
在上述控制器中,τi分为τia和τis两部分:τia为基于参数自适应的模型前馈补偿项;τis为积分鲁棒项;最后将自适应律和积分鲁棒两种控制方法复合,实现四旋翼姿态精准跟踪控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811246308.9A CN109358504B (zh) | 2018-10-24 | 2018-10-24 | 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811246308.9A CN109358504B (zh) | 2018-10-24 | 2018-10-24 | 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109358504A CN109358504A (zh) | 2019-02-19 |
CN109358504B true CN109358504B (zh) | 2021-07-02 |
Family
ID=65346425
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811246308.9A Expired - Fee Related CN109358504B (zh) | 2018-10-24 | 2018-10-24 | 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109358504B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110568764B (zh) * | 2019-10-15 | 2022-08-19 | 曲阜师范大学 | 考虑状态量化的飞行器系统抗干扰控制方法、系统、控制器 |
CN110673619B (zh) * | 2019-10-21 | 2022-06-17 | 深圳市道通智能航空技术股份有限公司 | 一种飞行姿态的控制方法、装置、无人机和存储介质 |
CN110928321B (zh) * | 2019-11-19 | 2022-10-21 | 南京海逸测控技术有限公司 | 一种四旋翼无人机姿态的鲁棒控制方法 |
CN111007877B (zh) * | 2019-11-20 | 2022-11-08 | 江苏信息职业技术学院 | 一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法 |
CN111650952B (zh) * | 2020-06-02 | 2023-09-22 | 河北雄安万泽科技有限公司 | 一种基于双干扰观测器四旋翼无人机分层抗干扰方法 |
CN111880553B (zh) * | 2020-08-11 | 2022-10-11 | 北京航空航天大学 | 一种考虑惯量不确定性的四旋翼无人机姿态控制方法 |
CN112578805B (zh) * | 2020-12-30 | 2024-04-12 | 湖北航天飞行器研究所 | 一种旋翼飞行器的姿态控制方法 |
CN115556111B (zh) * | 2022-10-26 | 2023-08-18 | 哈尔滨工业大学 | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104007663B (zh) * | 2014-05-13 | 2017-08-25 | 南京航空航天大学 | 一种含参数不确定性的四旋翼姿态自适应容错控制方法 |
DE102015114421A1 (de) * | 2015-08-28 | 2017-03-02 | Airbus Defence and Space GmbH | Autonomer L1-adaptiver Regler mit exakter Polvorgabe |
CN106679659B (zh) * | 2017-01-10 | 2019-08-09 | 中北大学 | 一种基于参数可调非线性跟踪微分器的信号去噪方法 |
CN107703952B (zh) * | 2017-08-29 | 2020-10-30 | 浙江工业大学 | 一种刚性飞行器的非奇异固定时间自适应姿态控制方法 |
CN108132604A (zh) * | 2017-12-27 | 2018-06-08 | 北京航空航天大学 | 基于四元数的四旋翼飞行器鲁棒姿态控制方法、装置及系统 |
CN108445766B (zh) * | 2018-05-15 | 2020-02-21 | 山东大学 | 基于rpd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 |
-
2018
- 2018-10-24 CN CN201811246308.9A patent/CN109358504B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN109358504A (zh) | 2019-02-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109358504B (zh) | 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 | |
CN110531777B (zh) | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和系统 | |
CN110308735B (zh) | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 | |
CN110119089B (zh) | 一种基于积分滑模的浸入不变流型自适应四旋翼控制方法 | |
CN109901605B (zh) | 一种四旋翼飞行器跟踪无人水面船的控制方法 | |
Zhen et al. | Adaptive super-twisting control for automatic carrier landing of aircraft | |
Lai et al. | Adaptive position/attitude tracking control of aerial robot with unknown inertial matrix based on a new robust neural identifier | |
CN111045440B (zh) | 一种高超声速飞行器俯冲段快速滚转控制方法 | |
CN107491083A (zh) | 一种基于饱和自适应滑模控制的四旋翼自主着船方法 | |
CN115826625B (zh) | 一种针对水下探测任务的无人机协调转弯飞行方法 | |
Wu et al. | Trajectory following control of UAVs with wind disturbance | |
CN112486193A (zh) | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 | |
CN107817818B (zh) | 一种模型不确定飞艇航迹跟踪有限时间控制方法 | |
CN110377044B (zh) | 一种无人直升机的有限时间高度和姿态跟踪控制方法 | |
CN113848990B (zh) | 一种考虑结构非线性的无人机稳定飞行控制方法 | |
Xu et al. | Learning pugachev's cobra maneuver for tail-sitter uavs using acceleration model | |
Wang et al. | A velocity-free adaptive RISE-based trajectory tracking approach for quadrotors with desired model compensation | |
Dasgupta et al. | A singularity-free hierarchical nonlinear quad-rotorcraft control using saturation and barrier lyapunov function | |
CN113110538A (zh) | 一种基于反步法控制的舰载机着舰固定时间容错控制方法 | |
CN116339140B (zh) | 一种基于瞬时自抗扰和自适应动态逆的复合容错控制方法 | |
Le Bras et al. | Nonlinear image-based visual servo controller for automatic landing guidance of a fixed-wing aircraft | |
Alcan et al. | Robust hovering control of a quadrotor using acceleration feedback | |
CN110647161A (zh) | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 | |
Salihbegovic et al. | High performance disturbance observer based control of the nonlinear 2DOF helicopter system | |
Zhao et al. | Immersion and invariance based adaptive attitude tracking control of a quadrotor UAV in the presence of parametric uncertainty |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210702 Termination date: 20211024 |
|
CF01 | Termination of patent right due to non-payment of annual fee |