摘要
为完善非线性系统预设性能跟踪控制过程中约束冲突问题的处理机制,并对系统施加更精细的约束,本文提出了一种基于新型可变障碍函数的性能约束控制方法。首先,对非线性系统约束控制中因初始状态不确定和期望轨迹突变导致的约束冲突问题进行分析,提出了一种新的非对称可变障碍函数构型。该构型为系统引入了吸引函数,能够统一处理约束冲突过程中的约束解除和约束恢复两个阶段,并能够丰富预设性能边界的设置形式,使得约束控制策略更加简单和完善。其次,基于设计的新型非对称可变障碍函数构型,设计一组新型L型预设性能边界函数。该组性能边界函数本身具有约束力,能够对系统输出的超调量施加定量约束,从而更精细地约束系统的行为。最后,对系统误差的有界性和前向不变性进行了证明,并基于Lyapunov函数稳定性理论证明所有闭环信号的一致最终有界性。选取四旋翼无人机系统进行数值仿真和实验对比,数值仿真和实验结果验证了所提方案的有效性和优越性。本文设计的吸引预设性能方法,能够在给系统施加定量超调约束的同时,解决约束过程中产生的约束冲突问题。
Abstract
To address the constraint conflict issues in the prescribed performance tracking control of nonlinear systems and simultaneously impose more refined constraints on the system, this paper proposes a constrainted performance control method based on a novel variable barrier function. Firstly, the problem of constraint conflicts caused by uncertain initial states and sudden changes in the expected trajectory in the constraint control of nonlinear systems is analyzed, and a new asymmetric variable barrier function configuration is proposed. This configuration introduces an attraction function to the system, which can uniformly handle the two stages of constraint release and constraint recovery during the constraint conflict process, and enrich the setting form of the preset performance boundary, making the constraint control strategy simpler and more complete. Secondly, based on the designed novel asymmetric variable barrier function configuration, a set of new L-shaped preset performance boundary functions is designed. These performance boundary functions are inherently constraining, capable of imposing quantitative constraints on the overshoot of the system output, thereby more precisely confining the system behavior. Finally, the boundedness of the system error and the forward invariance are proved, and the uniform ultimate boundedness of all closed-loop signals is proved based on the Lyapunov stability theory. A quadrotor unmanned aerial vehicle system is selected for numerical simulation and experimental comparison. The final numerical simulation and experimental results verify the effectiveness and superiority of the proposed scheme. The designed attraction-preserving performance method in this paper can not only impose quantitative overshoot constraints on the system, but also solve the constraint conflict problems arising during the constraint process.
针对实际系统中控制性能、状态或输出等某些变量的精细化约束问题,世界各国学者提出了丰富的约束控制策略[1-4]。目前,已有的约束控制方法往往通过预先定义一组性能边界来构造出安全区,并且保证系统的输出在安全区域内演变来达到对系统施加约束的目的。因此,如何构建具有完善约束机制的安全区,对约束控制的研究具有重要意义[5-8]。
比较常用于构造安全区并施加约束的控制方法有模型预测控制方法(model predictive control,MPC)和预设性能控制方法(prescribed performance control,PPC)。文献[9]基于MPC构建了一个安全区,并利用滑模控制器实现安全区域对系统变量的约束,但是文献[9]中构建的安全区域边界本身对系统误差不具有约束力。为了弥补这一不足,文献[10]基于障碍Lyapunov函数(barrier lyapunov function,BLF)构建了一个具有约束力的安全区域。常见的障碍李雅普诺夫函数有对数型[11-12],积分型[13-14]和正切型[15-16]。此类基于障碍Lyapunov函数构建的约束需满足系统初始状态必须在安全区内的假设。然而在某些情况下,系统的初始状态往往难以获取。文献[17]通过使安全区边界的初始范围扩展到无穷大来解决这个问题,但是这个方法只适用于性能函数为恒正或恒负的情况,且系统运行中的状态也可能会产生突变,这会导致被约束的系统状态逃逸出安全区,发生约束冲突。文献[18]研究了此类情况下系统的约束控制策略,通过引入反应边界保护方法生成新的安全轨迹来确保输出不会超出安全区,该方法的核心是通过当前的位置和速度对未来状态进行估计,并结合动态表面控制方法来预测并修正期望轨迹,然而预测和修正的计算过程比较复杂,较难应用高维或更强非线性系统。文献[19]提出了一种融合安全边界保护法,该方法通过设计一种安全边界的自调整机制来确保输出始终在安全边界内运行,并且取得了较好的成果。然而文献[18]和文献[19]均未考虑系统运行期间实际输出超出安全区域的情况,为此,设计一种发生约束冲突之后的处理机制,是约束控制过程中必须解决的问题。
除了完善约束控制中处理约束冲突的机制之外,如何对系统的瞬态性能进行更为精细的约束,也是约束控制中应考虑的重要问题。例如无人机在狭窄通道飞行或吊挂货物时,需约束系统误差超调量,以防止碰撞并减小货物摆动。文献[20]利用误差转移变换构建移位函数,能够将原始跟踪误差映射为初始条件为零的新误差变量,由此实现对系统超调的抑制。但该方法在超调抑制方面的有效性,是以无法预先设定超调约束条件为代价的。文献[21]通过基于障碍Lyapunov函数设计一组管状预设性能边界来给系统超调量施加约束,该方法虽然可以预先设置对系统的超调量的约束,但是对于控制过程中,输出状态逃逸出预设性能区域引发的约束冲突问题并没提出解决的策略。因此考虑在约束发生冲突的情况下,如何对系统施加更为丰富和精细的约束同样具有重要的实际意义。
本文将研究非线性系统预设性能跟踪控制中的约束冲突和超调定量约束问题。主要包括以下几方面:
1)如何处理约束控制过程中因初始条件未知和约束状态逃逸出安全区造成的约束冲突;
2)如何完善约束冲突处理过程中约束解除和约束恢复两个阶段控制策略;
3)如何在对系统超调施加定量约束的同时,引入完善的约束冲突处理机制。
1 系统描述及预备知识
1.1 系统描述
考虑如下二阶非线性系统:
(1)
式中:u∈R为控制输入,xi(i=1,2)为系统的状态;f(xi),g(xi)为已知的光滑函数,并满足局部Lipschitz条件;d(t)为外部扰动。
在本文中,考虑系统输出y=x1,因此可以将跟踪误差定义为
(2)
式中x1d为期望轨迹,遵循跟踪控制中的标准做法,本文做出如下假设:
假设1 期望轨迹x1d及其各阶导数已知且连续有界,i=1,2,···,n。
假设2 系统(1)中扰动d(t)的观测量满足,| -d(t)|≤ε,ε为已知的正常数。
控制目标:在给系统施加定量超调约束且初始跟踪条件未知的情况下,设计其捕捉预设性能跟踪控制器,保证系统具有如下特性:1)当系统跟踪误差超出安全区域边界,发生约束冲突时,系统输出可以被吸引至预设性能区域中,保证跟踪误差具有预设性能;2)即使在发生约束冲突的情况下,也可保证系统的超调满足定量约束。
1.2 预备知识
引理1 对于初始条件有界的系统,若存在一个C1连续且正定的Lyapunov函数V(x)满足
其中类函数且ρ、γ为正常数,则系统的解x(t)一致最终有界[22]。
引理2 假设V(x)是关于系统定义在包含原点的开区间D内的一个函数。如果V(x)满足以下性质,即:1)在区间D内连续可微且正定;2)当x接近区间D边界时,V(x)→∞;3)对于0和x(0)≥D,存在一个正数b,沿的解可得V(x)≤b,则函数V(x)是一个障碍Lyapunov函数[22]。
定义1 基于引理2,如果定义域D随时间t变化,且左右边界不对称,则称V(x)为非对称时变障碍Lyapunov函数。
1.3 吸引预设性能控制方法
传统的预设性能控制方法通常对系统跟踪误差进行约束,通过设计约束边界生成一个如图1所示的预设性能区域,其约束形式为
(3)
式中:均是单调的光滑函数,分别为约束上界和下界,e1为跟踪误差。
图1传统预设性能控制方法示意图
Fig.1Schematic diagram of traditional prescribed performance control method
此类方法通常假设初始误差e1(0)已知且满足,即初始误差必须处于预设性能区域之中,但在实际应用中,系统的初始状态往往难以确定,这将导致系统初始误差e1(0)处于预设性能区域之外,造成约束冲突;此外,在实际的轨迹跟踪控制过程中,由于规划路径更新造成的期望轨迹大幅突变也会使得系统误差e1超出预设性能区域,发生约束冲突。
为了处理预设性能控制过程中由于系统误差超出预设性能区域引发的约束冲突问题,本文提出了一种基于障碍Lyapunov函数的吸引预设性能控制方法(catch prescribed performance control,CPPC),其示意图如图2所示。
图2吸引预设性能控制方法示意图
Fig.2Schematic diagram of the catch prescribed performance control method
首先定义一个切换函数:
(4)
式中:e1为跟踪误差,为约束上界,B为约束下界,κ是为了判定是否发生约束冲突引入的判定项,其约束区域与吸引区域的详细情况及边界处右极限和左极限见附录标注1所示,为便于计算,下文将q(κ)记为q,在此基础上构造新型Lyapunov函数:
(5)
式中:q为切换函数,Vblf为障碍Lyapunov函数,用于构建预设性能区域,VS为吸引函数,通过设计VS,便可以在发生约束冲突时,将系统跟踪误差“吸引”至预设性能区域中。本文设计的VS和Vblf为:
(6)
式中:bp为正常数,用来设置吸引效率,Θ为转换误差,。
传统的障碍Lyapunov函数只能构建对称结构的预设性能区域,本文设计的Vblf丰富了预设性能区域的设置形式,使得预设性能区域的设置不再拘泥于对称的形式,进而对系统跟踪误差施加更为精确和灵活的约束。
1.4 L型预设性能边界函数
为了对系统跟踪误差超调量施加定量的约束,使得系统具有更好的瞬态性能,基于本文设计的新型障碍Lyapunov函数,进一步提出了一种L型预设性能边界函数,其示意图如图2所示。
(7)
(8)
式中:Ba0为ka的初始值,Ba∞为t→∞时ka的稳态值,c1为ka的收敛速度,Ba∞为正常数,ka>kb≥0。对于式(8)中的ka、kb进行微分可得: =-c1(Ba0-Ba∞)=0,当t≥0时,ka、kb是C1连续的;同时,当t→∞时 ka→Ba∞、kb→Bb∞,故中的边界是可达的。初始误差值e1(0)是系统开机后,通过传感器测得的量,且并无精度要求。不需要满足传统预设性能控制中Bb∞<e1(0)<Ba0的假设,也可以使得系统跟踪误差的超调量满足:
(9)
2 控制器设计
在本节中,针对前文提到的二阶非线性系统,设计具有输出误差超调约束的捕捉预设性能自适应控制器,使得系统输出y在满足定量超调约束的情况下,快速准确地对期望轨迹yd进行跟踪,控制器具体设计步骤如下。
Step 1:对式(2)定义的系统跟踪误差求导:
(10)
采用式(5)构造的新型的Lyapunov函数对系统误差e1进行约束,有:
(11)
根据式(6)设计其障碍Lyapunov函数Vblf和吸引函数VS,则有:
(12)
式中:q为式(4)定义的切换函数;e1为系统跟踪误差;为了施加定量超调约束,本文采用如式(7)所示的L型预设性能边界函数,记
对 Vp1求导可得:
(13)
式中:e2=x2-α,α为虚拟控制律。由式(13)可设计α为:
(14)
式中:γ1为大于零的常数;将式(14)代入式(13)中,可得:
(15)
Step 2:对式e2求导可得:
(16)
假设d(t)的估计值为,构造Lyapunov函数Vp2,表达式为:
(17)
对Vp2求导可得:
(18)
根据式(18),设计控制律:
(19)
式中:γ2为大于零的常数,sgn(·)为符号函数,η为鲁棒项参数,且η>ε。
将式(19)代入式(18)中,有
(20)
根据式(4),当系统跟踪误差发生约束冲突时,q=1,有:
(21)
根据LaSalle不变性原理,取≡0时,e1≡0,e2≡0,则有:
(22)
因此,当q=1时系统是收敛的。
根据式(4),当系统处于预设性能区域中,q=0,有:
(23)
下文对转换误差的有界性和预设性能区域的前向不变性进行证明。
根据杨氏不等式,有:
(24)
并根据式(23),有:
(25)
当γ2>时,令cv1=γ1,cv2=γ2-,cv3=ε2,记设集合,当时,即系统能量严格衰减;当x∈Ωx时, 、e2均有界,根据Lyapunov稳定性理论,系统状态最终会收敛到有界集Ωx,因此、e2全局有界。进一步,当有:
(26)
记时,根据引理 1,则有:
(27)
对式(27)两边同时积分,可得:
(28)
式中:由式(23)得:
(29)
解不等式(29)可得:
(30)
则有,即
结合上述有界性结论,本文通过反证法对前向不变性进行如下证明。
若存在某个时刻t*>0使得,则由系统状态的连续性可知,必存在一列时间 满足或这与上文推导的有界性矛盾,故假设不成立,即不存在某个时刻t*>0使得,即前向不变性成立。结合的几何结构易得出系统超调量满足:
将控制器设计过程中涉及的所有参数不等式及其需满足的条件收敛为一条可操作的不等式列表,具体见表1。
表1证明过程中的源条件梳理
Tab.1Verification of selected source conditions
3 稳定性证明
基于上节推导过程,对如下定理进行证明。
定理1 对于满足假设1与假设2的系统(1),若按照式(14)和式(19)分别设计系统的虚拟控制律和实际控制律,则:1)闭环系统中所有信号都是有界的;2)当系统产生约束冲突时,跟踪误差被吸引至预设性能区域中;3)系统超调量可以满足定量约束;
证明 1)证明有界性
选取公共障碍Lyapunov函数为
(31)
对 Vs 求导,可得
(32)
将由式(14)定义的虚拟控制律和由式(19)定义的控制律代入式(32)中,可得
(33)
当系统状态发生约束冲突时,0,根据式(12)可知,系统是收敛的;当系统状态处于预设性能区中时,,结合式(25)~式(30)的有界性和前向不变性分析可得出系统是收敛的。根据式(30)可知,Θ是有界的,根据式(23)和(33)可知,e1,e2为有界的,则结合式(14)和式(19)可得闭环系统中x1,x2,α,u都是有界的。
2)证明当系统产生约束冲突时,跟踪误差被吸引至预设性能区域中。
由式(20)~式(22)可知,如果系统发生约束冲突,则有故跟踪误差可以被吸引至预设性能区域中。
3)证明系统超调量可以满足定量约束。
由式(30)和式(12)可得
(34)
解不等式(34)可得
(35)
进而可以得到若e1处于预设性能区域之中,则系统跟踪误差满足如式(9)所示的超调定量约束。
4 仿真分析
为了验证本文所提捕捉预设性能控制方法(CPPC)的有效性及优越性,本节选取四旋翼无人机系统对本文提出的控制方案进行仿真分析。在有效性验证实验中,选取四旋翼无人机位置子系统的Z通道,验证本文所提方法对系统输出施加超调定量约束,以及解决系统约束冲突问题的效果;在对比实验中,设定较为复杂的“双叶草”轨迹,在施加扰动的同时,与文献[22]中基于传统正切型时变障碍Lyapunov控制方案(tan barrier lyapunov function,TBLF)、文献[23]中的非对称时变障碍Lyapunov函数控制方案(asymmetric barrier lyapunov function,ABLF)进行对比,对本文所提方法的优越性和鲁棒性进行验证。
四旋翼无人机系统的动力学[18]可分为由式(36)定义的位置子系统与由式(37)定义的姿态子系统:
(36)
(37)
其中:表示位置状态,为姿态状态,l为螺旋桨中心到重心的距离,m为机体的质量,g为重力加速度,ki为空气阻力系数,I1、I2、I3分别表示机体绕X、Y、Z轴的转动惯量[24],ux、uy、uz分别为:
(38)
以Fi表示每个旋翼产生的推力,总升力用u1表示,u2、u3、u4为虚拟控制输入量,ui (i=1,2,3,4)的定义如下:
(39)
四旋翼无人机的期望位置和期望角度表示为定义系统的误差变量为:其机体物理参数设定见表2。
表2四旋翼无人机机体物理参数
Tab.2Physical parameters of the quadrotor UAV body
4.1 有效性验证
根据式(1),选取四旋翼无人机位置子系统的Z通道可被描述为:
(40)
其中外部扰动d(t)=0.1sin(t),是扰动幅值为0.1的简谐扰动,设置跟踪的参考信号为:
(41)
在16 s时的轨迹突变的幅值为2.33,根据式(7)、式(8)设计相应的参数来构建预设性能区域,设计Ba0=3,Ba∞=0.05,c1=3,Bb∞=-0.05。选取不同的初始状态,其对应的初始误差如表3所示。
表3初始状态
Tab.3Initial state
根据式(14)和式(19)设计系统控制器的虚拟控制律和控制律,控制器的参数设置为:γ1=10,γ2=80,η=1,bp=200。并且通过表1中的合并源条件进行代入核对,仿真结果如图3所示。
图3中紫色实线为针对系统误差设计的预设性能边界Li(i=1,2,3,4)表示不同初始位置所对应初始误差的收敛曲线;在第15 s时,模拟由于期望轨迹改变导致发生的约束冲突。仿真结果表明,当系统跟踪误差超出安全区域边界,发生约束冲突时,系统输出可以被吸引至预设性能区域中,同时可以对系统超调量施加定量约束。验证了本文所提控制方法的有效性。
为验证吸引因子对系统的调节效果,选取不同的吸引因子进行对比实验,实验结果如图4所示,将系统第1次和第2次发生的冲突计为冲突1和冲突2,系统对两次约束冲突的调节时间如表4所示。
图3不同初始误差对系统跟踪效果的影响
Fig.3Influence of different initial errors on the tracking performance of the system
图4不同吸引因子对误差收敛速率的影响
Fig.4The influence of different attraction factors on the error convergence rate
表4约束冲突调节时间对比
Tab.4Comparison of constraint conflict resolution time
随着吸引因子变大,系统在处理约束冲突时,系统误差回复至安全区的时间变短,对系统的调节能力也随之增加。
4.2 对比实验
控制器采用双闭环控制结构,根据式(14)和式(19)分别设计无人机位置和姿态子系统控制器的虚拟控制律和实际控制律:
(42)
通过控制律ux、uy、uz和滚转角φd对本文中期望俯仰角θd、偏航角ψd进行解算,其中φd为给定值,根据式(38)可得:
(43)
四旋翼无人机的起飞场景是高为5 m的楼顶,设置跟踪轨迹为“双叶草”曲线,系统的初始条件设定为:[x(0),y(0),z(0)]T=[5,5,5]T,[φ(0),θ(0),ψ(0)]T=[0,0,0]T,设置四旋翼无人机的预设轨迹为:
(44)
在16 s时,X方向的轨迹突变的幅值为0.136,Y方向的轨迹突变的幅值为2.33,通过表1中的合并源条件进行代入核对,控制器的参数设置见表5所示。
其中r=x,y,z,φ,θ,ψ,并施加外界扰动为幅值为0.1的简谐扰动,dr(t)=0.1sin t,构建预设性能区域的相关参数见表6所示。
表5四旋翼无人机控制器参数表
Tab.5Parameters of the quadrotor UAV controller
表6构建预设性能区域的参数表
Tab.6Parameters for prescribed performance region construction
为了更好地体现出本文提出的控制方案的优越性,分别选取文献[22]中构建对称预设性能区的TBLF、文献[23]中构建非对称预设性能区域的ABLF两种控制方案,进行对比仿真实验。为了能够更为直观和清晰地观察出3种不同性能函数所构建出的预设性能区域之间的几何差异,以四旋翼无人机的位置子系统为例,绘制3种方案所构建的预设性能区域示意图如图5所示,文献[22]中的TBLF方案构建的对称预设性能区域由紫色实线和绿色实线构成,文献[23]中的ABLF方案构建的非对称预设性能区域由黄色实线和紫色实线构成,这两种控制方案均需要满足系统的初始状态在预设性能区域中的假设,本文所提的CPPC方法则由两条紫色实线构成,且由于吸引项的存在,本文方法无需满足初始状态在预设性能区域中的假设,适用于初始状态无法确定的情况。
图5预设性能区域对比
Fig.5Comparison of prescribed performance region
仿真结果如图6~图13所示,结果表明,本文方法在跟踪具有欠驱动、强耦合、非线性等特性的无人机系统的复杂轨迹时仍具有较好的效果。能够在对系统施加定量的超调约束的情况下对约束冲突进行处理。相对于文献[22]中的TBLF方案,本文具有更快的跟踪速度和更高的跟踪精度,同时解算出的角度波动的幅值更小、波动时间更短。文献[23]中的方法虽然跟踪精度和本文方法相近,且解算角度的波动比本文方法较小,但其解算角度幅值较大,跟踪速度差于本方法,且文献[22]和文献[23]均不适用于初始条件未知的情况。
图8中系统误差的预设性能边界用紫色实线表示,在初始时刻,X、Y、Z通道的系统误差并未在预设性能区域之中发生约束冲突,本文所提的控制方法能够较快的将系统误差吸引至预设性能区中;而文献[22]和文献[23]的方法则需预先获得初始误差的值,并设计如图5所示更大的预设性能区。由于期望轨迹在第16 s发生了改变,因此造成Z通道误差超出预设性能区域,发生约束冲突,在恢复后精度与文献[23]中的ABLF方法接近的情况下,本文所提方法的调节约束冲突的时间明显更快,虽然调节时间与文献[22]中的TBLF接近,但文献[22]中的TBLF调节过程不够平稳,精度明显差于本方法,且造成了二次冲突。本文方法对X、Y、Z通道的跟踪速度皆快于其他两种方法。
图6跟踪效果对比
Fig.6Comparison of tracking effect
图7位置跟踪曲线
Fig.7Position tracking curves
图8位置误差收敛曲线
Fig.8Convergence curve of position error
图13是四旋翼无人机系统的控制输入,可以看出,与其他两种方法相比,3种方法的控制输入u1在稳态值相近,但本文采用的方法波动幅值明显小于其他两种方法,虽然由于解决约束冲突导致虚拟控制量u4的波动时间比文献[23]中的ABLF方法稍长,但其波动幅值在后期明显衰减,且波动时间明显小于文献[22]中的TBLF方案。与此同时,本文方法的虚拟控制量u2、u3的波动时间、波动幅值和波动次数,明显小于其他两种方法,且控制输入较小。
图9俯仰角(a)和偏航角(b)跟踪曲线(CPPC)
Fig.9Pitch (a) and yaw (b) angle tracking curves (CPPC)
图10俯仰角(a)和偏航角(b)跟踪曲线(TBLF)
Fig.10Pitch (a) and yaw (b) angle tracking curves (TBLF)
图11俯仰角(a)和偏航角(b)跟踪曲线(ABLF)
Fig.11Pitch (a) and yaw (b) angle tracking curves (ABLF)
图12横滚角跟踪曲线
Fig.12Roll angle tracking curve
图13控制输入跟踪曲线
Fig.13Input control contrast curve
5 结论
1)本文提出的新型可变障碍函数构型同时具有约束力和吸引力,能够解决由于初始条件未知和约束状态逃逸出安全区产生的约束冲突问题,并且能够统一处理约束解除和约束恢复两个阶段,通过调节吸引因子对吸引速率进行调节。
2)本文设计的基于可变障碍Lyapunov函数的控制方法适用于初始条件难以获取的情况,且对系统的超调具有定量约束。
3)本文考约束冲突和超调定量约束设计的自适应控制器,能够实现四旋翼无人机系统输出对期望轨迹快速准确的高精度跟踪控制。
4)仿真实验表明,本文提出的吸引预设性能控制框架能够对较为复杂的非线性系统施加超调定量约束,且可以适用于约束控制中的约束冲突问题。
附录
标注1:
当时,κ<0系统误差处于预设性能区域中,q(κ)=0,系统未发生约束冲突,吸引函数未作用,预设性能区域对系统进行约束控制;
当e1≥时,κ≥0系统状态超出约束上界,q(κ)=1,发生约束冲突,约束控制系统解除的同时吸引函数作用,将系统状态吸引至预设性能区域中;
当e1<时,κ>0系统状态超出约束下界,q(κ)=1,发生约束冲突,约束控制系统解除的同时吸引函数作用,将系统状态吸引至预设性能区域中;
当时,κ→-∞系统状态从预设性能区域内部逼近约束下界,q(κ)=0,系统未发生约束冲突,吸引函数未作用,预设性能区域对系统进行约束控制;
当e1→-时,κ→+∞系统状态从预设性能区域内部逼近约束下界,q(κ)=1,系统逼近预设性能区域,吸引函数继续作用,将系统状态吸引至预设性能区域中。

