CN111610721B - 模型参数完全未知的带负载四旋翼无人机速度控制方法 - Google Patents
模型参数完全未知的带负载四旋翼无人机速度控制方法 Download PDFInfo
- Publication number
- CN111610721B CN111610721B CN202010706239.6A CN202010706239A CN111610721B CN 111610721 B CN111610721 B CN 111610721B CN 202010706239 A CN202010706239 A CN 202010706239A CN 111610721 B CN111610721 B CN 111610721B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- unknown
- load
- controller
- 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
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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
- G05D13/62—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover characterised by the use of electric means, e.g. use of a tachometric dynamo, use of a transducer converting an electric value into a displacement
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种模型参数完全未知的带负载四旋翼无人机速度控制方法,包括步骤1)建立带负载四旋翼无人机的动力学模型,2)设定对无人机的速度跟踪误差ev=v‑v*,ew=w‑w*,3)使用矩阵分解对未知增益矩阵B进行预处理,4)设计模型参数完全未知情况下带负载四旋翼无人机的平移子系统和旋转子系统的控制器。本发明考虑了带负载无人机在模型参数完全未知、时变未知增益矩阵、执行器饱和与执行器故障等实际应用条件,解决了带负载后增益矩阵未知情况下的控制器设计问题,所提出的控制器不仅可以保证闭环系统中所有内部信号有界且连续,并且确保最终误差收敛于一个小的紧集,而且可以在取得良好的轨迹跟踪性能过程中确保不违反状态约束条件。
Description
技术领域
本发明涉及无人机控制技术领域,特别涉及一种带负载的四旋翼无人机的速度控制方法。
背景技术
旋翼式无人机的动力系统是由多个旋翼提供推力的。例如四旋翼无人机,当四个带电机的螺旋桨产生的推力大于无人机自身的重力和空气阻力的时候,无人机就能够起飞。通过控制系统反馈状态信息,调整每个电机的转速来改变每个旋翼的转速来进行无人机的姿态飞行控制。
在实际应用中,四旋翼无人机不可避免地需要携带任务设备或相机来执行特定任务。通常,四旋翼无人机一般采用夹持和悬挂两种方法。例如,航拍摄影的时候,就必须采用夹持方式,这是为了防止四旋翼无人机因为大风等外部环境原因飞行不稳定导致相机产生强烈的抖动,影响拍摄效果;当检测地雷时,又必须采用悬挂方法,只有绳索足够长才能确保四旋翼无人机的安全和完成既定任务。因此,研究四旋翼无人机携带载荷具有重要的现实意义。
目前,许多的研究集中在四旋翼无人机的建模和控制上。一般来说,四旋翼无人机的6自由度动力学模型可以通过使用拉格朗日方法或欧拉方程来推导。但是,大多数研究都采用了经典四旋翼无人机模型,其中假设无人机质心是固定的并且是已知的,即质心与无人机机身几何中心处于同一位置。实际上,在携带载荷以后,整个四旋翼无人机运载系统的质心通常都会发生一定的偏移,导致质心与机身几何中心不在同一位置,同时转动惯量也会发生变化,这些不确定性因素都会影响四旋翼无人机控制系统的稳定性。因此,给无人机的数学建模工作和控制策略设计带来艰巨性、复杂性和挑战性。
由于四旋翼无人机始终需要在动态环境中保证连续稳定飞行,控制器所需求的控制量可能超过无人机执行器所提供的最大控制量,这就会造成无人机控制系统性能急速下降,无法正常完成指定任务,甚至引发控制系统的崩溃。同时,无人机也可能发生执行器、状态、传感器等故障,也将导致性能显著下降,甚至发生坠机等灾难性后果。此外,四旋翼无人机在实际飞行中存在许多物理条件约束问题,例如位置约束、速度约束、性能、安全规格等。
而且在更为普遍的实际应用中,控制器往往无法依赖准确的模型参数,比如并未加装相应的测量传感器、观测误差或传感器故障等等,为此,进一步考虑在不依赖模型参数或者说模型参数完全未知条件下,设计出相应的容错控制器,在保证无人机稳定飞行的前提下,尽管控制性能可能有所降低,但这种做法却更加符合实际应用需要,具有更强的普适性。
因此,在四旋翼无人机的控制系统设计中,同时考虑带负载、模型参数完全未知、执行器饱和、执行器故障和状态约束条件更加具有实际价值。
发明内容
有鉴于此,本发明的目的是提供一种模型参数完全未知的带负载四旋翼无人机速度控制方法,以解决在同时考虑带负载、模型参数完全未知、受负载摆动影响情况下系统模型中增益矩阵时变未知动态特性、执行器饱和、执行器故障和状态约束条件下的四旋翼无人机速度控制问题。
本发明模型参数完全未知的带负载四旋翼无人机速度控制方法,包括以下步骤:
1)建立带负载四旋翼无人机的动力学模型,具体表示如下:
上式中,fa(·)和fb(·)代表模型的耦合项,A=diag{m+m0;m+m0;m+m0}和表示增益矩阵,m表示无人机的质量,m0表示负载的质量,M1表示惯性矩阵,ut是速度控制量,ur是角速度控制输入;Fp1是负载施加在无人机上的额外力Fp中不含状态量和v的剩余项;Mp1是负载施加于无人机的额外力矩Mp中不含有状态变量和w的剩余项;da(·)和db(·)代表系统模型的不确定项;向量v=[vx,vy,vz]T表示在机体坐标系下的线速度,为v的一阶导数,为带负载四旋翼无人机平移子系统;向量w=[wx,wy,wz]T表示在机体坐标系下的角速度,是w的一阶导数,为带负载的四旋翼无人机的旋转子系统;机体坐标系表示为Ob=(Xb,Yb,Zb),机体坐标系的原点Ob取在四旋翼的质心位置上,Xb轴在四旋翼对称轴内指向机头方向,Zb轴在无人机对称平面内,Zb轴垂直于Xb轴指向上方,按右手定则确定Yb轴;
考虑无人机的物理结构和性能指标限制,无人机的速度和角速度都需要满足如下限制:|v|≤kv,|w|≤kw,其中kv和kw是无人机的速度和角速度极所能达到的最大极限值;
考虑输入饱和影响,由于转速限制,ui=[ut,ur],i=1,...,6;不再是设计的控制输入,系统模型表示如下:
此处,p(ui)表示受非对称非光滑的饱和非线性影响的控制输入,定义为
那么,p(ui)可以表示为其中Ψ(ui)是p(ui)和之差;因函数和饱和度函数p(ui)的有界性质,因此函数Ψ(ui)是有界的,即|Ψ(ui)|≤Ψm,其中Ψm是正定未知的常数;为方便起见,对函数采用均值定理,变成其中且0<λ<1;通过选择ui0=0并利用事实p(0)=0,得到由此引入以下变量:对于所有 是不变的,并且存在正定常数gmax,使得因此,有0<gi≤gmax<∞;最后非线性系统(2)变成:
考虑执行器故障,此时的控制输入不再是ui而是uai=ρi(t)ui+δi(t)(i=1,...,6),其中ρi(t)∈(0,1]表示执行器效率因子,δi(t)表示由部分控制动作产生的时变且不可测量的矢量函数;将式(4)的模型变成如下等式:
上式中,Gt=Gt1ρt,ρt=diag{ρ1,ρ2,ρ3},Lt2(·)=AGt1δt+Lt1(·),Gr=Gr1ρr,ρr=diag{ρ4,ρ5,ρ6},Lr2(·)=BGr1δr+Lr1(·);
2)设定对无人机的速度跟踪误差,具体包括:
设定平移跟踪误差为ev=v-v*,旋转跟踪误差为ew=w-w*,定义期望参考为和期望参考v*(t)和w*(t)是已知和有界的,即满足对任意的t≥0,有|v*|≤Av<kv和|w*|≤Aw<kw,其中kv和kw是无人机的速度和角速度极限值,Av=[Av1,Av2,Av3]T和Aw=[Aw1,Aw2,Aw3]T是小于极限值的正常数已知向量;
将式(5)转换成跟踪误差的动力学模型如下等式:
3)使用矩阵分解对未知增益矩阵B进行预处理,具体包括:
建立的无人机数学模型的增益矩阵B是未知的,设计模型参数完全未知的控制器之前需要对增益矩阵B进行预处理,从式(6)知道B(·)不是对称正定矩阵,而Gr是正定对角矩阵;将B(·)矩阵分解为
B(·)=S(·)DU(·) (7)
其中S(·)是一个对称正定矩阵,U(·)是一个单位上三角矩阵,是一个对角阵,其中R=diag{1,..,1}是单位对角矩阵,Q是任意正对角矩阵;此外,存在未知的常数Dm,使得0<Dm<Di<Dn;然后,在式(6)的旋转子系统两边乘以S-1,得到
其中Jx为四旋翼无人机在机体坐标系下绕Xb轴旋转的转动惯量,Jy为四旋翼无人机在机体坐标系下绕Yb轴旋转的转动惯量,JZ为四旋翼无人机在机体坐标系下绕Zb轴旋转的转动惯量;U-I是严格上三角矩阵并且Gr=diag{Gr1,...,Gn},0<Gri≤1,此处Gr1=g4ρ4,Gr2=g5ρ5,Gr3=g6ρ6;然后有
4)设计模型参数完全未知情况下带负载四旋翼无人机的平移子系统和旋转子系统的控制器,并通过设计的控制器控制无人机系统,具体包括:
第一步,考虑式(6)里面的平移子系统,设计基于模型参数完全未知的受状态约束平移控制器,并实现所需的跟踪控制目标:
为了确保不违反v的约束,即|v|<kv,根据BLF的性质,将李雅普诺夫函数的第一部分定义为
其中kb为正定常数向量,与此同时,定义一个紧凑集合Ωev={ev:|ev|<kb},满足V1在紧凑集合Ωev中是有效的;为了使不等式|v|<kv成立,kb被选定成:
kb=kv-Av (11)
由于ev=v-v*和|v*|≤Av,所以|v|≤|ev|+|v*|<kb+Av=kv-Av+Av=kv;
控制器ut的定义为
其中,σ1>0是控制器设计参数;
第二步,考虑式(6)误差跟踪动态的旋转子系统,设计基于模型参数完全未知的受状态约束姿态控制器,并实现所需的跟踪控制目标:
为了确保不违反角速度w的约束,即|w|<kw,根据势垒函数BLF的性质,将李雅普诺夫函数的第一部分定义为
kc=kw-Aw (15)
ew=w-w*和|w*|≤Aw,有|w|≤|ew|+|w*|<kc+Aw=kw-Aw+Aw=kw;
控制器uri和更新律定义为:
本发明的有益效果:
1、本发明模型参数完全未知的带负载四旋翼无人机速度控制方法,以带负载的四旋翼无人机为研究对象,在同时考虑时变未知增益矩阵、执行器饱和与执行器故障等实际应用条件下,建立了带负载四旋翼无人机的6自由度动力学模型;并针对受状态约束的情况,设计了不依赖模型参数的两种自适应容错控制器,以应对模型参数完全未知这一种实际应用中最为典型的工况。理论分析和仿真结果表明,所提出的控制器不仅可以保证闭环系统中所有内部信号有界且连续,并且确保最终误差收敛于一个小的紧集,而且可以在取得良好的轨迹跟踪性能过程中确保不违反状态约束条件。
2、本发明模型参数完全未知的带负载四旋翼无人机速度控制方法,针对现有关于带负载四旋翼无人机的动力学模型研究仅考虑了质心时变,而忽略了转动惯量时变的影响,本发明考虑了受负载摆动影响情况下系统模型中增益矩阵时变未知动态特性,解决带负载后增益矩阵未知情况下的控制器设计问题,可以更准确地反映无人机系统的动态过程,所设计的控制器能更好地满足无人机控制的实际需求。
3、本发明模型参数完全未知的带负载四旋翼无人机速度控制方法,针对实际飞行中经常遇到的执行器饱和情况下控制性能下降问题,本发明通过定义良好的平滑函数,无需事先知道输入饱和度的界限即可处理具有未知不对称性和非平滑度的执行器输入饱和故障;针对实际飞行中受物理条件限制情况下的系统状态约束问题,本发明通过引入李雅普诺夫势垒函数和反步法,所设计的控制器能自适应容错和满足状态约束要求。
4、本发明模型参数完全未知的带负载四旋翼无人机速度控制方法,其考虑了实际飞行中悬挂负载摆动角不可观测这种情况,所设计的控制器具有更好的普适性。
附图说明
图1为悬挂了载荷的四旋翼无人机动力学示意图。
图2为带状态约束的速度轨迹跟踪v。
图3为带状态约束的角速度轨迹跟踪w。
图4为带状态约束的速度跟踪误差ev。
图5为带状态约束的角速度跟踪误差ew。
图6为带状态约束下四旋翼无人机控制输入。
图7为带状态约束下悬挂负载的摆动角。
具体实施方式
下面结合附图和实施例对本发明作进一步描述。
本实施例中模型参数完全未知的带负载四旋翼无人机速度控制方法,包括以下步骤:
1)建立带负载四旋翼无人机的动力学模型,包括:
为了精确的描述悬挂负载的四旋翼无人机的姿态和位置信息,定义如下坐标系:
①地球固联坐标系(e系)
也称地面坐标系,表示为Oe=(Xe,Ye,Ze)。将地心作为坐标原点Oe,Xe轴在水平面内指向某一方向,Ze轴垂直于地面向上。然后,按右手定则确定Ye轴。
②机体坐标系(b系)
也称体轴系,表示为Ob=(Xb,Yb,Zb)。与四旋翼无人机固连,其原点Ob取在四旋翼的质心位置上。Xb轴在四旋翼对称轴内指向机头方向。Zb轴在无人机对称平面内,Zb轴垂直于Xb轴指向上方。然后,按右手定则确定Yb轴。
③悬挂点坐标系(h系)
绳子的悬挂点与无人机质心位置是不一致的,为了准确描述悬挂负载的运动,需要建立悬挂点坐标系,表示为Oh=(Xh,Yh,Zh)。其原点Oh取四旋翼机体悬挂点位置。其它三轴的方向分别与四旋翼无人机机体坐标系的方向矢量平行。
定义ξ=[x,y,z]T表示四旋翼无人机在e系下的位置向量,η=[φ,θ,ψ]T表示四旋翼无人机在e系下的姿态向量,其中三个欧拉角分别表示横滚角φ,俯仰角θ和偏航角ψ。向量v=[vx,vy,vz]T表示在b系下的线速度,向量ve=[vex,vey,vez]T表示Ob在e系下的线速度,有向量w=[wx,wy,wz]T表示在b系下的角速度。位置矢量和线速度之间的转换关系为:
类似地,b系下的角速度与e系下的欧拉角之间的转换关系可以写成
假设机体坐标系在地面坐标系中以角速度w旋转,对于任意向量A,满足
上式中,m为四旋翼无人机的质量,向量F=[Fx,Fy,Fz]T表示作用在四旋翼无人机上xyz三个方向的分力。由力学分析表示,四旋翼无人机受到的合外力包括四旋翼无人机总升力和自身重力。因此,在机体坐标系下,四旋翼无人机的总升力FT在xyz三个方向的分力如下:
其中κ>0为升力系数,Ωi为第i(i=1,2,3,4)个螺旋桨的转速。在机体坐标系下,无人机的重力可表示为
因此,四旋翼无人机所受的合外力为:
F=FT+FG (9)
再由角动量定理,物体角动量的变化等于力矩的冲量,可得
Mdt=d(Jw) (10)
其中,向量M=[uφ,uθ,uψ]T是指输入转矩矢量,J为在机体坐标系下四旋翼无人机的转动惯量,且假定为常数,如下表示
将(式5)和(6)结合起来,可得到
上式(12)为不考虑悬挂负载的四旋翼无人机平移子系统的动力学模型。
通常,可以假设将转动惯量矩阵J的非对角项视为一个小数项,当有两个小数项相乘时,可以被忽略。此假设比普通无人机模型更仔细地考虑了四旋翼无人机的质量不对称性。所以,将式(5)和(10)结合起来,可得到
上式中,将J看作一个常数矩阵,使之计算较为简便。
结合式(12)和(13),四旋翼无人机的6-DOF动力学模型可以如下描述
上式中的系数矩阵以及其详细表达如下所示:
图1表示带有悬挂负载的四旋翼无人机动力学示意图。如果不考虑附加的有效载荷,无人机质心将始终与几何中心(即原点Ob)重合。但是,在实际飞行中,由于悬挂有效载荷施加摆动的影响,无人机质心将随时间变化,不再与原点Ob一致。将变化的质心表示为C点。由于将额外的有效负载视为质点P,因此可以忽略悬挂负载的空气阻力。将无人机和负载分开单独分析,先分析得出负载的运动模型,将负载施加在无人机的额外力和额外力矩视作与无人机本体独立的附加分量,直接导入四旋翼无人机数学模型中,就可以得到带负载的四旋翼无人机动力学模型。坐标系框架h的单位矢量始终保持与框架b的单位矢量平行。负载的位置信息由两个摆动角α和β描述,其中α是缆绳长度l与Zb负方向之间的角度,β是l投影到XbObYb平面的投影线和YbObZb平面之间的角度。根据刚体力学定理,负载在悬挂坐标系(h系)中的位置矢量由下式给出:
rp=[xp,yp,zp]T=[lsinαsinβ,-lsinαcosβ,-lcosα]T (15)
定义悬挂点Oh在机体坐标系上的位置矢量为rh=[0,0,-zh]T。则负载在机体坐标系下的绝对速度vp为:
其中r=rp+rh是负载在机体坐标系下的位置矢量。悬挂负载在机体坐标系下的绝对加速度ap为:
此外,负载在机体坐标系下所受的重力矢量gp表示如下:
其中m0表示负载的质量。忽略负载所受的空气阻力,根据牛顿第二运动定律,负载通过绳子作用在四旋翼无人机悬挂点的拉力Fp为
Fp=-m0ap+gp (19)
负载通过绳子作用在四旋翼无人机悬挂点的力矩Mp为
Mp=rh×Fp (20)
上式中,矢量Fp=[Fpx,Fpy,Fpz]T和Mp=[Mpx,Mpy,Mpz]T都是α和β的函数。负载的运动受到悬挂点处力矩平衡的限制,可得:
-rp×(-m0ap+gp)=0 (21)
将上式展开,可得α和β的表达式,简化后为
其中,c1,c2,c3表达式如下所示:
首先,通过将额外力Fp施加到机体平移的动力学模型(12)中,得到带负载的四旋翼无人机的平移子系统:
然后,将Mp视为负载带来的额外力矩施加到式(13)中,得到带负载的四旋翼无人机的旋转子系统:
最后,结合式(23)和(24),得到带有负载的四旋翼无人机的动力学模型,如下所示:
m1=m0zh(zh+lcosα),m2=m0lzhsinαsinβ,m3=-m0lzhsinαcosβ
c12=wzm0zh(zh+lcosα)+wxm0zhlsinαsinβ-Jyzwy-(Jz-Jy)wz
c22=m0zhwylsinαsinβ+wxzhm0lsinαcosβ+Jyzwx-Jxywz
c31=Jxywx+(Jx-Jy)wy,c32=Jxywy+Jxzwz,c33=Jyzwx
为了方便控制器设计,可以将式(25)分解为以下两个子系统的动力学模型:
平移动力学:
旋转动力学:
其中,和代表模型的耦合项,A=diag{m+m0;m+m0;m+m0}和表示增益矩阵。与式(14)表示的四旋翼无人机模型相比,式(27)表示的旋转子系统的控制增益不再是已知增益矩阵B1,由于M1与时变未知的摆动角相关,因此旋转子系统的控制增益矩阵B成为时变且未知的,这导致了带负载飞行情况下控制器设计的困难。选择控制量ut=[Fx/(m+m0),Fy/(m+m0),Fz/(m+m0)]T和ur=[uφ,uθ,uψ]T。da(·)和db(·)代表系统模型的不确定项。
考虑无人机的物理结构和性能指标限制,无人机的速度和角速度都需要满足如下限制:|v|≤kv,|w|≤kw,其中kv和kw是无人机的速度和角速度极所能达到的最大极限值;
考虑输入饱和影响对无人机系统的影响,由于转速限制,ui=[ut,ur](i=1,...,6)不再是设计的控制输入。系统模型(26)和(27)表示如下
此处,p(ui)表示受非对称非光滑的饱和非线性影响的控制输入,定义为
那么,p(ui)可以表示为其中Ψ(ui)是p(ui)和之差。因函数和饱和度函数p(ui)的有界性质,可知函数Ψ(ui)是有界的。即|Ψ(ui)|≤Ψm,其中Ψm是正定未知的常数。为方便起见,对函数采用均值定理,变成其中且0<λ<1。通过选择ui0=0并利用事实p(0)=0,得到由此引入以下变量:对于所有 是不变的,并且存在正定常数gmax,使得因此,有0<gi≤gmax<∞。最后,非线性系统(2.28)和(2.29)变成
此外,在实际飞行中,四旋翼无人机存在发生执行器故障的情况。只要执行器故障产生,系统控制输入不再是ui而是uai=ρi(t)ui+δi(t)(i=1,...,6),其中ρi(t)∈(0,1]表示执行器效率因子,δi(t)表示由部分控制动作产生的时变且不可测量的矢量函数。当ρi=1,δi=0时,意味着四旋翼无人机的执行器是完美的并且可以正常工作;ρi≠0,δi≠0时,意味着四旋翼无人机发生了部分执行器故障;ρi=0意味着四旋翼无人机中对应的执行器完全无效,即完全失控。
由此,考虑到执行器故障,将式(31)和(32)分别改写为:
平移动力学:
旋转动力学:
上式中,Gt=Gt1ρt,ρt=diag{ρ1,ρ2,ρ3},Lt2(·)=AGt1δt+Lt1(·),Gr=Gr1ρr,ρr=diag{ρ4,ρ5,ρ6},Lr2(·)=BGr1δr+Lr1(·)。
2)设定对无人机的速度跟踪误差,具体包括:
为了便于控制器设计和稳定性分析,定义期望参考为和期望参考v*(t)和w*(t)是已知和有界的,即满足对任意的t≥0,有|v*|≤Av<kv和|w*|≤Aw<kw,其中kv和kw是无人机的速度和角速度极限值,Av=[Av1,Av2,Av3]T和Aw=[Aw1,Aw2,Aw3]T是小于极限值的正常数已知向量。
因此,将平移跟踪误差和旋转跟踪误差分别定义为
ev=v-v* (35)
ew=w-w* (36)
然后,从式(33)到(36)可知,跟踪误差的动力学模型可以写成
3)使用矩阵分解对未知增益矩阵B进行预处理,具体包括:
建立的无人机数学模型的增益矩阵B是未知的,设计模型参数完全未知的控制器之前需要对增益矩阵B进行预处理,从式(38)知道B(·)不是对称正定矩阵,而Gr是正定对角矩阵;将B(·)矩阵分解为
B(·)=S(·)DU(·) (39)
其中S(·)是一个对称正定矩阵,U(·)是一个单位上三角矩阵,是一个对角阵,其中R=diag{1,..,1}是单位对角矩阵,Q是任意正对角矩阵;此外,存在未知的常数Dm,使得0<Dm<Di<Dn;然后,在式(38)的两边乘以S-1,得到
其中Jx为四旋翼无人机在机体坐标系下绕Xb轴旋转的转动惯量,Jy为四旋翼无人机在机体坐标系下绕Yb轴旋转的转动惯量,JZ为四旋翼无人机在机体坐标系下绕Zb轴旋转的转动惯量;U-I是严格上三角矩阵并且Gr=diag{Gr1,...,Gn},0<Gri≤1,此处Gr1=g4ρ4,Gr2=g5ρ5,Gr3=g6ρ6;然后有
4)设计模型参数完全未知情况下带负载四旋翼无人机的平移子系统和旋转子系统的控制器,并通过设计的控制器控制无人机系统,具体包括:
第一步,考虑式(37)里面的平移子系统,设计基于模型参数完全未知的受状态约束平移控制器,并实现所需的跟踪控制目标:
为了确保不违反v的约束,即|v|<kv,根据BLF的性质,将李雅普诺夫函数的第一部分定义为
其中kb为正定常数向量,与此同时,定义一个紧凑集合Ωev={ev:|ev|<kb},满足V1在紧凑集合Ωev中是有效的;为了使不等式|v|<kv成立,kb被选定成:
kb=kv-Av (43)
由于ev=v-v*和|v*|≤Av,所以|v|≤|ev|+|v*|<kb+Av=kv-Av+Av=kv;
控制器ut的定义为
其中,σ1>0是控制器设计参数;
第二步,考虑式(38)误差跟踪动态的旋转子系统,设计基于模型参数完全未知的受状态约束姿态控制器,并实现所需的跟踪控制目标:
为了确保不违反角速度w的约束,即|w|<kw,根据势垒函数BLF的性质,将李雅普诺夫函数的第一部分定义为
kc=kw-Aw (47)
ew=w-w*和|w*|≤Aw,有|w|≤|ew|+|w*|<kc+Aw=kw-Aw+Aw=kw;
控制器uri和更新律定义为:
下面采用仿真实验来验证本实施例中控制方法的有效性。
实验中,选择系统状态约束分别为kv=[2,1.6,3.2]T和kw=[2.3,2.2,3]T,以及系统状态的期望值约束分别为Av=[0.5,0.4,2.1]T和Aw=[0.6,0.5,0.1]T。当0<t<5s时,平移子系统期望轨迹为v*=[0.1*cos(t);-0.2*sin(t);0.5*t],旋转子系统期望轨迹为w*=[-0.4*sin(t);0.3*cos(t);0];当t≥5s时,平移子系统期望轨迹为v*=[0.1*cos(t);-0.2*sin(t);2.5],旋转子系统期望轨迹为w*=[-0.4*sin(t);0.3*cos(t);0]。
四旋翼无人机的速度和角速度轨迹跟踪及跟踪误差,分别如图2-图5所示。从仿真结果可以看出,本实施例中所提出的控制方法能够实现对期望轨迹的有效跟踪。此外,状态轨迹都在约束范围内,状态约束问题得到了很好的解决。同时,跟踪误差ev和ew保持在很小的误差范围内,并达到最终一致有界。
图6显示的是受状态约束下所设计的自适应容错控制器的控制输入。图7显示了跟踪过程中吊挂载荷的摆角大小,小摆角表明所设计的控制器可以使四旋翼无人机具有良好的飞行稳定性。结果表明,所提出的控制策略使无人机能够从远离参考轨迹的初始位置以较小的延迟跟随参考轨迹。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (1)
1.一种模型参数完全未知的带负载四旋翼无人机速度控制方法,其特征在于:包括以下步骤:
1)建立带负载四旋翼无人机的动力学模型,具体表示如下:
上式中,fa(·)和fb(·)代表模型的耦合项,A=diag{m+m0;m+m0;m+m0}和表示增益矩阵,m表示无人机的质量,m0表示负载的质量,M1表示惯性矩阵,ut是速度控制量,ur是角速度控制输入;Fp1是负载施加在无人机上的额外力Fp中不含状态量和v的剩余项;Mp1是负载施加于无人机的额外力矩Mp中不含有状态变量和w的剩余项;da(·)和db(·)代表系统模型的不确定项;
向量v=[vx,vy,vz]T表示在机体坐标系下的线速度,为v的一阶导数,为带负载四旋翼无人机的平移子系统;向量w=[wx,wy,wz]T表示在机体坐标系下的角速度,是w的一阶导数,为带负载四旋翼无人机的旋转子系统;机体坐标系表示为Ob=(Xb,Yb,Zb),机体坐标系的原点Ob取在四旋翼的质心位置上,Xb轴在四旋翼对称轴内指向机头方向,Zb轴在无人机对称平面内,Zb轴垂直于Xb轴指向上方,按右手定则确定Yb轴;
考虑无人机的物理结构和性能指标限制,无人机的速度和角速度都需要满足如下限制:|v|≤kv,|w|≤kw,其中kv和kw是无人机的速度和角速度极所能达到的最大极限值;
考虑输入饱和影响,由于转速限制,ui=[ut,ur],i=1,...,6;不再是设计的控制输入,系统模型表示如下:
此处,p(ui)表示受非对称非光滑的饱和非线性影响的控制输入,定义为
那么,p(ui)表示为其中Ψ(ui)是p(ui)和之差;因函数和饱和度函数p(ui)的有界性质,因此函数Ψ(ui)是有界的,即|Ψ(ui)|≤Ψm,其中Ψm是正定未知的常数;对函数采用均值定理,变成其中且0<λ<1;通过选择ui0=0并利用事实p(0)=0,得到由此引入变量:对于所有 是不变的,并且存在正定常数gmax,使得因此,有0<gi≤gmax<∞;最后非线性系统(2)变成:
考虑执行器故障,此时的控制输入不再是ui而是uai=ρi(t)ui+δi(t)(i=1,...,6),其中ρi(t)∈(0,1]表示执行器效率因子,δi(t)表示由部分控制动作产生的时变且不可测量的矢量函数;将式(4)的模型变成如下等式:
上式中,Gt=Gt1ρt,ρt=diag{ρ1,ρ2,ρ3},Lt2(·)=AGt1δt+Lt1(·),Gr=Gr1ρr,ρr=diag{ρ4,ρ5,ρ6},Lr2(·)=BGr1δr+Lr1(·);
2)设定对无人机的速度跟踪误差,具体包括:
设定平移跟踪误差为ev=v-v*,旋转跟踪误差为ew=w-w*,定义期望参考为和期望参考v*(t)和w*(t)是已知和有界的,即满足对任意的t≥0,有|v*|≤Av<kv和|w*|≤Aw<kw,其中kv和kw是无人机的速度和角速度极限值,Av=[Av1,Av2,Av3]T和Aw=[Aw1,Aw2,Aw3]T是小于极限值的正常数已知向量;
将式(5)转换成跟踪误差的动力学模型如下等式:
3)使用矩阵分解对未知增益矩阵B进行预处理,具体包括:
将B(·)矩阵分解为
B(·)=S(·)DU(·) (7)
其中Jx为四旋翼无人机在机体坐标系下绕Xb轴旋转的转动惯量,Jy为四旋翼无人机在机体坐标系下绕Yb轴旋转的转动惯量,JZ为四旋翼无人机在机体坐标系下绕Zb轴旋转的转动惯量;U-I是严格上三角矩阵并且Gr=diag{Gr1,...,Gn},0<Gri≤1,此处Gr1=g4ρ4,Gr2=g5ρ5,Gr3=g6ρ6;然后有
4)设计模型参数完全未知情况下带负载四旋翼无人机的平移子系统和旋转子系统的控制器,并通过设计的控制器控制无人机系统,具体包括:
第一步,考虑式(6)里面的平移子系统,设计基于模型参数完全未知的受状态约束平移控制器,并实现所需的跟踪控制目标:
为了确保不违反v的约束,即|v|<kv,根据BLF的性质,将李雅普诺夫函数的第一部分定义为
其中kb为正定常数向量,与此同时,定义一个紧凑集合Ωev={ev:|ev|<kb},满足V1在紧凑集合Ωev中是有效的;为了使不等式|v|<kv成立,kb被选定成:
kb=kv-Av (11)
由于ev=v-v*和|v*|≤Av,所以|v|≤|ev|+|v*|<kb+Av=kv-Av+Av=kv;
控制器ut的定义为
其中,σ1>0是控制器设计参数;
第二步,考虑式(6)误差跟踪动态的旋转子系统,设计基于模型参数完全未知的受状态约束姿态控制器,并实现所需的跟踪控制目标:
为了确保不违反角速度w的约束,即|w|<kw,根据势垒函数BLF的性质,将李雅普诺夫函数的第一部分定义为
kc=kw-Aw (15)
ew=w-w*和|w*|≤Aw,有|w|≤|ew|+|w*|<kc+Aw=kw-Aw+Aw=kw;
控制器uri和更新律定义为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010706239.6A CN111610721B (zh) | 2020-07-21 | 2020-07-21 | 模型参数完全未知的带负载四旋翼无人机速度控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010706239.6A CN111610721B (zh) | 2020-07-21 | 2020-07-21 | 模型参数完全未知的带负载四旋翼无人机速度控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111610721A CN111610721A (zh) | 2020-09-01 |
CN111610721B true CN111610721B (zh) | 2022-03-15 |
Family
ID=72200532
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010706239.6A Active CN111610721B (zh) | 2020-07-21 | 2020-07-21 | 模型参数完全未知的带负载四旋翼无人机速度控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111610721B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112068598B (zh) * | 2020-09-28 | 2021-11-16 | 西北工业大学 | 一种无人机编队飞行方法及控制系统 |
CN112650269B (zh) * | 2021-01-02 | 2022-07-26 | 西北工业大学 | 一种多无人机协同运输系统的载荷跟踪控制方法 |
CN113238572B (zh) * | 2021-05-31 | 2022-11-22 | 上海海事大学 | 基于预设性能控制的预设时间四旋翼无人机姿态跟踪方法 |
CN113741502B (zh) * | 2021-09-15 | 2023-08-25 | 重庆大学 | 输出约束下带负载四旋翼无人机的神经网络控制方法 |
CN113885314B (zh) * | 2021-10-22 | 2023-05-23 | 电子科技大学 | 一种具有未知增益和干扰的非线性系统跟踪控制方法 |
CN116483107A (zh) * | 2023-05-11 | 2023-07-25 | 哈尔滨工业大学(深圳) | 一种四旋翼无人机的非级联控制障碍函数 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479567A (zh) * | 2017-09-13 | 2017-12-15 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
CN109597426A (zh) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 |
CN111308897A (zh) * | 2020-04-22 | 2020-06-19 | 中北大学 | 一种考虑机载资源受限的四旋翼保性能量化控制方法 |
-
2020
- 2020-07-21 CN CN202010706239.6A patent/CN111610721B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479567A (zh) * | 2017-09-13 | 2017-12-15 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
CN109597426A (zh) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 |
CN111308897A (zh) * | 2020-04-22 | 2020-06-19 | 中北大学 | 一种考虑机载资源受限的四旋翼保性能量化控制方法 |
Non-Patent Citations (1)
Title |
---|
Adaptive fault-tolerant flight control for a quadrotor UAV with slung payload and varying COG;Lian Tan等;《2019 3rd International Symposium on Autonomous Systems(ISAS)》;20190711;第227-231页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111610721A (zh) | 2020-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111610721B (zh) | 模型参数完全未知的带负载四旋翼无人机速度控制方法 | |
CN111722645B (zh) | 模型参数已知的带负载四旋翼无人机速度控制方法 | |
CN110065070B (zh) | 一种基于动力学模型的机器人自适应阻抗控制系统 | |
Bisheban et al. | Geometric adaptive control with neural networks for a quadrotor in wind fields | |
Zhang et al. | Robust control of an aerial manipulator based on a variable inertia parameters model | |
Das et al. | Dynamic inversion with zero-dynamics stabilisation for quadrotor control | |
Jayakrishnan | Position and attitude control of a quadrotor UAV using super twisting sliding mode | |
Xu et al. | Sliding mode control of a quadrotor helicopter | |
Dhadekar et al. | Robust control of quadrotor using uncertainty and disturbance estimation | |
CN108647442B (zh) | 一种基于辅助输出的六旋翼无人机故障估计方法 | |
Yilmaz et al. | Nonlinear adaptive control of an aerial manipulation system | |
Liu et al. | Robust motion control of quadrotors | |
Islam et al. | A comparative study of PD, LQR and MPC on quadrotor using quaternion approach | |
Das et al. | Sliding mode approach to control quadrotor using dynamic inversion | |
Albayrak et al. | Design of a robotic bicopter | |
Zhong et al. | Active fault-tolerant tracking control of a quadrotor with model uncertainties and actuator faults | |
CN111459188A (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
CN116069050A (zh) | 一种抗扰动的旋翼无人机吊载系统减摇控制方法及装置 | |
CN116300466A (zh) | 一种旋翼无人机集群协同吊运点质量载荷的鲁棒控制方法 | |
CN113848990B (zh) | 一种考虑结构非线性的无人机稳定飞行控制方法 | |
Ouyang et al. | Control of an aerial manipulator using a quadrotor with a replaceable robotic arm | |
Liu et al. | Non‐linear adaptive tracking control for quadrotor aerial robots under uncertain dynamics | |
Pedro et al. | Direct adaptive neural control of a quadrotor unmanned aerial vehicle | |
Yu et al. | Compensating aerodynamics of over-actuated multi-rotor aerial platform with data-driven iterative learning control | |
CN107102549B (zh) | 参数不确定条件下空间绳系机器人目标逼近姿轨稳定控制方法 |
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 |