CN112558468A - 基于双观测器的发射平台自适应鲁棒输出反馈控制方法 - Google Patents

基于双观测器的发射平台自适应鲁棒输出反馈控制方法 Download PDF

Info

Publication number
CN112558468A
CN112558468A CN202011280272.3A CN202011280272A CN112558468A CN 112558468 A CN112558468 A CN 112558468A CN 202011280272 A CN202011280272 A CN 202011280272A CN 112558468 A CN112558468 A CN 112558468A
Authority
CN
China
Prior art keywords
platform
adaptive
observer
following
error
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.)
Granted
Application number
CN202011280272.3A
Other languages
English (en)
Other versions
CN112558468B (zh
Inventor
胡健
邢浩晨
徐晨晨
陈伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Science and Technology
Original Assignee
Nanjing University of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Science and Technology filed Critical Nanjing University of Science and Technology
Priority to CN202011280272.3A priority Critical patent/CN112558468B/zh
Publication of CN112558468A publication Critical patent/CN112558468A/zh
Application granted granted Critical
Publication of CN112558468B publication Critical patent/CN112558468B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种基于双观测器的发射平台自适应鲁棒(ARC)输出反馈控制方法(ARCFZ)。该控制方法是针对如下问题提出的:发射平台由方位框架和俯仰框架两部分构成,两者的数学模型基本一致。在发射平台的工作过程中,由于传动系统中存在的粘性摩擦力、齿隙、两轴耦合、未知干扰等问题,将严重恶化发射平台伺服系统的跟踪性能。以上问题,使得发射平台伺服系统的控制器设计变得更加困难。所公开的控制方法有效地自适应了发射平台系统不好获取的参数,并解决了传统ARC控制方法设计过程中存在的所需速度不好获取以及存在强外部干扰鲁棒性会变差的问题,保证了发射平台伺服系统优良的跟踪性能。

Description

基于双观测器的发射平台自适应鲁棒输出反馈控制方法
技术领域
本发明涉及机电伺服控制技术领域,主要涉及一种基于双观测器的发射平台自适应鲁棒输出反馈控制方法。
背景技术
发射平台由方位框架和俯仰框架两部分构成,两者的数学模型基本一致,因此可以以方位伺服系统为对象进行控制器的设计和仿真研究。在发射平台的工作过程中,一方面,由于传动系统中存在的粘性摩擦力、齿隙等机械传动问题,将严重恶化发射平台的跟踪性能。另一方面,发射平台存在方位和俯仰两个方向的运动,两者方向的运动相互耦合,产生耦合力,也会对发射平台的跟踪性能造成严重的影响,与此同时,发射平台的俯仰和方位运动耦合系数以及伺服系统受到的常值干扰也是很难测出。以上问题,使得伺服转塔系统的控制器设计变得更加困难。故针对发射平台设计有效的控制器将是提高发射平台的跟踪性能的关键所在。
针对发射平台的控制问题,许多方法相继被提出。其中自适应鲁棒控制(ARC)以其自身对不确定参数和常值干扰的自适应和对时变干扰的鲁棒性及能够获得渐近跟踪的稳态性能的优点,使其成为设计发射平台控制器的较佳方法。但在传统的自适应控制方法的控制器设计和实际应用中,由于在对系统位置进行高精度伺服控制的过程中设计自适应鲁棒控制器的时要用到系统的速度信号。但是,当受到强外部干扰时,此方法的鲁棒性会变差,并且速度信号往往不好用传感器获取到,传统的做法是使用位置信号进行微分处理。但是由于位置信号存在测量噪声,得到的速度信号往往不理想。如先用滤波器对位置信号进行滤波处理,将会引入延时,使得到的位置信号不是实时信号。因而传统ARC控制方法具有很大的工程局限性。
通过上述分析,本发明基于传统的ARC控制方法,融合一阶滑模观测器以及模糊观测器的思想,设计基于输出反馈的自适应鲁棒控制器。有效地自适应了伺服转塔系统不好获取的参数,并解决了传统ARC控制方法设计过程中存在的所需速度不好获取,以及在强外部干扰下鲁棒性变差的问题。保证了伺服转塔系统优良的跟踪性能。
发明内容
本发明的目的在于提供一种自适应了发射平台不好获取的参数,解决传统ARC控制方法在控制器设计和实现过程中需要发射平台的速度信号,并保证ARC在强外部干扰下的控制性能这一问题的控制方法。
实现本发明目的的技术解决方案为:一种基于发射平台的自适应鲁棒输出反馈控制方法,包括以下步骤:
步骤1,建立发射平台的数学模型,转入步骤2;
步骤2,根据发射平台的数学模型,设计用于输出反馈的自适应鲁棒控制器,转入步骤3;
步骤3,运用李雅普诺夫稳定性理论进行稳定性证明,在滑模观测器误差存在的情况下得到有界稳定的结果,在滑模观测器误差不存在的情况下,在有限的时间之后运用Barbalat引理可得到系统的全局渐近稳定的结果。
本发明与现有技术相比,其显著优点是:有效地自适应了发射平台不好获取的参数,解决传统ARC控制方法在控制器设计和实现过程中需要发射平台的速度信号,并保证ARC在强外部干扰下的控制性能。仿真结果验证了其有效性。
附图说明
图1是本发明发射平台的原理图。
图2是自适应鲁棒输出反馈控制方法原理示意图。
图3是系统无干扰时本发明所设计的ARCFZ控制器与传统ARC和PID控制方法在系统输出对期望指令的跟踪误差对比图,其中图a为指令信号图,图b为无干扰下PID控制方法跟踪误差图,图c是无干扰下ARC控制器跟踪误差图,图d是无干扰下ARCFZ控制器跟踪误差图。
图4是系统无干扰时本发明所设计的滑模观测器对x1的估计曲线图。
图5是系统无干扰时本发明所设计的滑模观测器对x2的估计曲线图。
图6是系统无干扰时本发明所设计的ARCFZ控制器对系统参数θ的估计曲线图。
图7是系统干扰为f(t)=(0.1x1x2-15u)(N·m)时本发明所设计的ARCFZ控制器与传统ARC和PID控制方法在系统输出对期望指令的跟踪误差对比图,其中图a为指令信号图,图b为有干扰下PID控制方法跟踪误差图,图c是有干扰下ARC控制器跟踪误差图,图d是有干扰下ARCFZ控制器跟踪误差图。
图8是系统干扰为f(t)=(0.1x1x2-15u)(N·m)时本发明所设计的滑模观测器对x1的估计曲线图。
图9是系统干扰为f(t)=(0.1x1x2-15u)(N·m)时本发明所设计的滑模观测器对x2的估计曲线图。
图10是系统干扰为f(t)=(0.1x1x2-15u)(N·m)时本发明所设计的ARCFZ控制器对系统参数θ的估计曲线图。
图11是系统干扰为f(t)=(0.1x1x2-15u)(N·m)时本发明所设计的模糊观测器对系统干扰f(t)的估计曲线图。
具体实施方式
下面结合附图及具体实施例对本发明作进一步详细说明。
结合图1~2,本发明基于双观测器的发射平台自适应鲁棒输出反馈控制方法,包括以下步骤:
步骤1,建立发射平台的数学模型,具体如下:
本发明所考虑的发射平台由方位框架和俯仰框架两部分构成,两者的数学模型基本一致,因此可以以方位伺服系统为对象进行控制器的设计和仿真研究。本发射平台通过配有电气驱动器的永磁直流电机驱动两方向的惯性负载。考虑到电磁时间常数比机械时间常数小得多,且电流环速度远大于速度环和位置环的响应速度,故可将电流环近似为比例环节。
因此,以发射平台方位伺服系统为对象。根据牛顿第二定律,发射平台的运动方程为:
Figure BDA0002780539180000031
式中y表示惯性负载的位移,Jeq表示惯性负载参数,ku表示电机输出端电压与力矩放大系数,u为发射平台方位伺服系统的自适应鲁棒控制器控制输入,Beq代表发射平台方位伺服系统的粘性摩擦系数,dn为发射平台方位伺服系统的常值干扰,f(t)表示发射平台方位伺服系统的其他未建模干扰,比如非线性摩擦,外部干扰以及未建模不确定,ω为俯仰伺服系统的角速度,
Figure BDA0002780539180000032
为俯仰伺服系统的角加速度,c1是对应ω的耦合系数,c2是对应
Figure BDA0002780539180000041
的耦合系数;
Figure BDA0002780539180000042
代表粘性摩擦力,且发射平台方位伺服系统参数都大于0。
为了方便后续控制器的设计与系统稳定性分析,在不影响系统跟踪精度的前提下,作出如下假设:
假设1:上述动力学模型中的参数都是一个常量或者渐变量,为了设计出可行性较好的控制器,在本发明中将所有发射平台方位伺服系统参数当作一个常量来处理。也就是说:
Figure BDA0002780539180000043
假设2:f(t)是未知的时变扰动,但具有一定的上下界,且上下界已知;
假设3:发射平台方位伺服系统所有参数都是有界的,且上下界均已知;
定义不确定参数矩阵θ:
Figure BDA0002780539180000044
则发射平台的运动方程简化为
Figure BDA0002780539180000045
即得发射平台的数学模型;
其中不确定非线性d(t)=f(t)/Jeq,定义
Figure BDA0002780539180000046
将发射平台的数学模型用状态空间表示为:
Figure BDA0002780539180000047
假设4:参数不确定矩阵θ以及不确定非线性d(t)满足:
Figure BDA0002780539180000048
其中,Ωθ是参数不确定矩阵θ的区间,δd(t)是f(t)的上界。
步骤2,所述输出反馈自适应鲁棒控制器,步骤如下:
步骤2.1、建立模糊干扰观测器:采用模糊观测器估计外界干扰与其他估计误差的和,在控制输入中进行前馈补偿;通过IF-THEN规则构造模糊逻辑系统:
R(i):若x1
Figure BDA0002780539180000049
且x2
Figure BDA00027805391800000410
则D(x)是Si
其中
Figure BDA00027805391800000411
为属于x1的模糊集合,
Figure BDA00027805391800000412
为属于x2的模糊集合,Si为结论的模糊集合;D(x)为所要估计的函数。
采用乘积推理机、单值模糊器和中心平均解模糊器来设计模糊控制器,即:
Figure BDA0002780539180000051
式中,
Figure BDA0002780539180000052
为xi的隶属度函数,
Figure BDA0002780539180000053
l1为x1的模糊规则条数,l2为x2的模糊规则条数,n为常量。
定义模糊基函数ρl1l2(x):
Figure BDA0002780539180000054
取模糊控制器的输入为x=[x1 x2]T,ρl1l2(x)简化为ρ(x),则模糊逻辑系统的输出为:
Figure BDA0002780539180000055
上式中
Figure BDA0002780539180000056
是β的估计值,β是模糊逻辑系统的可调参数值;
引理1:根据模糊逻辑系统的万能逼近定理,若D(x)是定义在紧集Ω上的连续函数,则对于给定的任意常数ε1>0,存在上述等式(9)定义的模糊逻辑系统,使得如下不等式
Figure BDA0002780539180000057
当x∈Ω时成立。
Figure BDA0002780539180000058
则:
Figure BDA0002780539180000059
将模糊控制作为一个干扰观测器,求解式(5)中不确定非线性d(t);即如下式:
Figure BDA00027805391800000510
步骤2.2、建立滑模观测器:
仅使用角度位置测量信息重建发射平台全部状态的滑模观测器,通过滑模观测器估计的状态信息实现闭环系统的输出反馈控制。
假设发射平台方位伺服系统状态x2是不可测的,只有x1可测;为了估计发射平台的状态,根据式(5)和式(11),设计如下的滑模观测器:
Figure BDA00027805391800000511
其中
Figure BDA0002780539180000061
为外界干扰与其他估计误差和的估计,λ1和λ2均为滑模观测器的增益,且
Figure BDA0002780539180000062
等效输出注入项
Figure BDA0002780539180000063
Figure BDA0002780539180000064
是通过对信号
Figure BDA0002780539180000065
使用低通滤波器滤波后得到的,该观测器的设计将使对系统状态的估计在有限时间内一个接一个的收敛到真实值。
定理1:存在一组观测器增益λ1、λ2,使得式(5)以及式(12)能观测到状态x1、x2在有限时间内收敛到相应的状态值;
证明:定义观测器误差为
Figure BDA0002780539180000066
其中x=[x1 x2]T是每一个通道的状态向量,其中
Figure BDA0002780539180000067
为观测到的状态向量,e=[e1 e2]T;则定义如下的观测器动态误差:
Figure BDA0002780539180000068
将其简化:
Figure BDA0002780539180000069
将式(14)带入式(13)可得:
Figure BDA00027805391800000610
其中
Figure BDA00027805391800000611
中间变量
Figure BDA00027805391800000612
对于误差e1选择如下的Lyapunov函数:
Figure BDA00027805391800000613
可得:
Figure BDA00027805391800000614
所以当λ1≤-max|e2|,则保证
Figure BDA00027805391800000615
因此状态e1将收敛至滑模面e1=0为了说明该收敛将在有限时间内发生,定义中间函数
Figure BDA00027805391800000616
且增益λ1<-e22,其中正实数ε2>0;有:
Figure BDA00027805391800000617
定义中间函数f(t,W1)=-ε2,则有
Figure BDA0002780539180000071
中间函数
Figure BDA0002780539180000072
则g(0)=W1(e1(0)),则有:
Figure BDA0002780539180000073
使用比较法则引理,推出W1(t)≤g(t),可得:
W1(t)≤W1(e1(0))-ε2t (20)
从该式中看出,由于W1(t)=|e1(t)|,所以|e1|将会在某个时刻T1等于0;因此,在T1时刻之后,误差e1将会收敛到0;由于在滑模面上有
Figure BDA0002780539180000074
求解等效输出注入项
Figure BDA0002780539180000075
在T1时刻之后,有如下误差:
Figure BDA0002780539180000076
对于误差e2选择如下的Lyapunov函数:
Figure BDA0002780539180000077
可得:
Figure BDA0002780539180000078
所以兰
Figure BDA0002780539180000079
则保证
Figure BDA00027805391800000710
因此误差e2将收敛至滑模面e2=0;
步骤2.3、对于自适应控制,为了避免发射平台方位伺服系统不确定性参数的自适应过程有发散的危险,给参数自适应过程添加不连续映射,定义向量
Figure BDA00027805391800000711
表示位置参数θ的自适应估计,
Figure BDA00027805391800000712
Figure BDA00027805391800000713
表示估计误差,即
Figure BDA00027805391800000714
一个不连续映射定义如下
Figure BDA00027805391800000715
式中,i=1、2、3、4、5;
设计如下自适应律:
Figure BDA0002780539180000081
式中,Γ为正定对角矩阵,τ为参数自适应函数。
由上式可知,不连续映射使得参数自适应过程是一个受控的过程,其意义在于使得估计的参数不超过预先给定的参数范围;对于任意的参数自适应函数τ,保证下式成立:
P1:
Figure BDA0002780539180000082
P2:
Figure BDA0002780539180000083
步骤2.4、设计自适应鲁棒控制器:
u=ua+us
Figure BDA0002780539180000084
Figure BDA0002780539180000085
其中,ua是模型的前馈补偿项,us为反馈项,us反馈项可以分为线性反馈项us1和非线性鲁棒反馈项us2,k2为正反馈增益。
步骤2.4.1、定义x2eq作为x2的虚拟控制输入,定义以下控制误差:
Figure BDA0002780539180000086
其中k1为正反馈增益,z1为位置跟踪误差,z2为速度跟踪误差;由于z1(s)=G(s)z2(s),G(s)=1/(s+k1)是一个稳定传递函数,因此让z1趋向于0等价于让z2趋向于0;接下来的目的是让z2趋向于0;根据式(5),得
Figure BDA0002780539180000087
步骤2.4.2、对实际自适应鲁棒控制器u设计控制律以便让z2趋向于0;根据式(29),自适应鲁棒控制器u为:
Figure BDA0002780539180000088
将式(30)带入式(29)得:
Figure BDA0002780539180000091
定义
Figure BDA0002780539180000092
则上式被改写成:
Figure BDA0002780539180000093
设计参数
Figure BDA0002780539180000094
的自适应律为:
Figure BDA0002780539180000095
上式中Γ1为模型参数θ的自适应速律矩阵,Γ2为可调参数β的自适应速律矩阵;
在式(30)中,设计
Figure BDA0002780539180000096
其中hs为所有误差的上界,即:
Figure BDA0002780539180000097
且ε是一个正实数;具有以下特性:
Figure BDA0002780539180000098
步骤3、运用李雅普诺夫稳定性理论进行稳定性证明,在滑模观测器误差存在的情况下得到有界稳定的结果,在滑模观测器误差不存在的情况下,在有限的时间之后运用Barbalat引理可得到系统的全局渐近稳定的结果,具体如下:
定理2:当滑模观测器误差
Figure BDA0002780539180000099
时,根据式(32)和式(33)所设计的控制器能够获得渐近跟踪的性能;
证明:建立如下的Lyapunov函数:
Figure BDA00027805391800000910
对上式进行求导可得:
Figure BDA00027805391800000911
由于模型参数θ和模糊逻辑系统的可调参数β都被认为是一个常量,所以具有以下性质:
Figure BDA00027805391800000912
将式(37)进行化简得到:
Figure BDA00027805391800000913
运用式(25)和式(33)可得:
Figure BDA0002780539180000101
由于k2为一正的增益,故
Figure BDA0002780539180000102
亘小于零,也就是说是
Figure BDA0002780539180000103
亘成立的;根据李雅普诺夫稳定性定理可知,所设计的控制器能够获得渐进跟踪的性能;
定理3:根据式(30)、式(32)和式(35)所设计的控制器能够获得有界稳定的性能;
证明:建立如下的Lyapunov函数:
Figure BDA0002780539180000104
对上式进行求导可得:
Figure BDA0002780539180000105
由于k2为一正的增益,根据李雅普诺夫稳定性定理可知,所设计的控制器能够获得有界稳定的性能。
因此有结论:针对发射平台伺服系统(1)设计的输出反馈自适应鲁棒控制器可以使系统得到全局渐近稳定的结果,调节观测器参数λ1、λ2和控制器增益k1、k2及Γ1、Γ2可以使系统的跟踪误差在时间趋于无穷的条件下趋于零。伺服转塔系统输出反馈自适应鲁棒控制原理示意图如图2所示。
实施例
使用MATLAB进行仿真实验,验证本发明所提算法的可行性。发射平台方位系统的控制框图如图2所示,其中x1为角速度状态,即发射平台方位子系统的输出角速度信号,x1d为发射平台方位子系统的期望跟踪姿态。表1为发射平台机电伺服系统方位回转轴系的系统参数设计。
表1回转电机伺服系统的规格参数
Figure BDA0002780539180000106
选择以下的三种控制器作为比较:
(1)ARCFZ:这是自适应鲁棒控制器(如式30),具有模糊干扰观测器(如式11)、滑模状态观测器(如式12)和自适应率(如式33),在本发明中提出并给出了描述。两轴耦合系数c1=0.13,c2=0.2,单位为N·m·s/rad。控制器增益选择为k1=300,k2=200,参数θ的范围为θmin=[100,1,1,1,1]T,θmax=[10000,100,100,100,100]T,其方位轴的角度信号为w=sin(πt),θ初始值为θ0=[4000,15,10,15,10]T自适应增益矩阵为Γ1=diag[2000,100,10,5,10],β的自适应增益阵Γ2=50×I25.滑模观测器的增益为λ1=-5,λ2=-8。
(2)ARC:这是自适应鲁棒控制器(如式30),具有自适应率(如式33),其中
Figure BDA0002780539180000111
控制器参数与ARCFZ中的相应参数相同。
(3)PID:这是传统的位置速度电流三回路比例积分微分控制器。其增益分别为kp=30,ki=4,kd=0,分别表示比例增益、积分增益和导数增益。
给定三个控制器的运动轨迹信号为:x1d=3sin(πt)(1-e-0.5t),分为以下两种情况进行测试:
(1)工作环境为无外部干扰的情况下。
无干扰情况下,三个控制器下的期望运动轨迹和相应的跟踪性能如图3所示。可以看出ARC和ARCFZ控制性能明显优于传统PID控制,通过图4,图5可以看出无干扰下滑模观测器的状态估计基本上趋近于真值。图6分别为无干扰下参数估计图。
(2)通过对物理运动系统施加0.1x1x2-15u的外部干扰,这种扰动使系统的动力学几乎完全改变,可以认为是最彻底的验证。
在这种情况下,三个控制器下的期望运动轨迹和相应的跟踪性能如图7所示。可以看出ARC控制性能明显受到比较大的影响,从图10和图11可以看出ARCFZ对参数和干扰的有着良好的逼近效果,从图8,图9可以看出ARCFZ对真实状态有着较好的估计效果,所以其控制性能并没有下降太多。
综上所述,ARCFZ具有较好的跟踪性能和良好的鲁棒性,且能较好地解决强外部干扰的问题。

Claims (6)

1.一种基于发射平台的自适应鲁棒输出反馈控制方法,其特征在于,包括以下步骤:
步骤1,建立发射平台的数学模型,转入步骤2;
步骤2,根据发射平台的数学模型,设计用于输出反馈的自适应鲁棒控制器,转入步骤3;
步骤3,运用李雅普诺夫稳定性理论进行稳定性证明,在滑模观测器误差存在的情况下得到有界稳定的结果,在滑模观测器误差不存在的情况下,在有限的时间之后运用Barbalat引理可得到系统的全局渐近稳定的结果。
2.根据权利要求1所述的发射平台的输出反馈的自适应鲁棒控制方法,其特征在于,步骤1中,建立发射平台的数学模型,具体如下:
所考虑的发射平台包括方位框架和俯仰框架,所述发射平台通过配有电气驱动器的永磁直流电机驱动两方向的惯性负载;考虑到电磁时间常数比机械时间常数小得多,且电流环速度远大于速度环和位置环的响应速度,故将电流环近似为比例环节;
以发射平台方位伺服系统为对象,根据牛顿第二定律,发射平台的运动方程:
Figure FDA0002780539170000011
式中y表示惯性负载的位移,Jeq表示惯性负载参数,ku表示电机输出端电压与力矩放大系数,u为发射平台方位伺服系统的自适应鲁棒控制器控制输入,Beq代表发射平台方位伺服系统的粘性摩擦系数,dn为发射平台方位伺服系统的常值干扰,f(t)表示发射平台方位伺服系统的其他未建模干扰,ω为俯仰伺服系统的角速度,
Figure FDA0002780539170000012
为俯仰伺服系统的角加速度,c1是对应ω的耦合系数,c2是对应
Figure FDA0002780539170000013
的耦合系数;
Figure FDA0002780539170000014
代表粘性摩擦力,且发射平台方位伺服系统参数都大于0;
为了方便后续自适应鲁棒控制器的设计与发射平台方位伺服系统稳定性分析,在不影响发射平台方位伺服系统跟踪精度的前提下,作出如下假设:
假设1:
Figure FDA0002780539170000015
假设2:f(t)是未知的时变扰动,但具有一定的上下界,且上下界已知;
假设3:发射平台方位伺服系统所有参数都是有界的,且上下界均已知;
定义不确定参数矩阵θ:
Figure FDA0002780539170000021
则发射平台的运动方程简化为
Figure FDA0002780539170000023
即得发射平台的数学模型;
其中不确定非线性d(t)=f(t)/Jeq,定义
Figure FDA0002780539170000024
将发射平台的数学模型用状态空间表示为:
Figure FDA0002780539170000025
假设4:参数不确定矩阵θ以及不确定非线性d(t)满足:
Figure FDA0002780539170000026
其中,Ωθ是参数不确定矩阵θ的区间,δd(t)是f(t)的上界。
3.根据权利要求2所述的发射平台的输出反馈的自适应鲁棒控制方法,其特征在于:发射平台方位伺服系统的其他未建模干扰包括非线性摩擦,外部干扰以及未建模不确定都由模糊观测器估计得到。
4.根据权利要求2所述的发射平台的输出反馈自适应鲁棒控制方法,其特征在于,步骤2中,根据发射平台的数学模型,设计用于输出反馈的自适应鲁棒控制器,步骤如下:
步骤2.1、建立模糊干扰观测器:
采用模糊观测器估计外界干扰与其他估计误差的和,在控制输入中进行前馈补偿;通过IF-THEN规则构造模糊逻辑系统:
R(i):若x1
Figure FDA0002780539170000027
且x2
Figure FDA0002780539170000028
则D(x)是Si
其中
Figure FDA0002780539170000029
为属于x1的模糊集合,
Figure FDA00027805391700000210
为属于x2的模糊集合,Si为结论的模糊集合;D(x)为所要估计的函数;
采用乘积推理机、单值模糊器和中心平均解模糊器来设计模糊控制器,即:
Figure FDA0002780539170000022
式中,
Figure FDA00027805391700000211
为xi的隶属度函数,
Figure FDA00027805391700000212
l1为x1的模糊规则条数,l2为x2的模糊规则条数,n为常量;
定义模糊基函数ρl1l2(x):
Figure FDA0002780539170000031
取模糊控制器的输入为x=[x1 x2]T,ρl1l2(x)简化为ρ(x),则模糊逻辑系统的输出
Figure FDA0002780539170000036
为:
Figure FDA0002780539170000032
上式中
Figure FDA0002780539170000037
是β的估计值,β是模糊逻辑系统的可调参数值;
引理1:根据模糊逻辑系统的万能逼近定理,若D(x)是定义在紧集Ω上的连续函数,则对于给定的任意常数ε1>0,存在上述等式(9)定义的模糊逻辑系统,使得如下不等式
Figure FDA0002780539170000038
当x∈Ω时成立;
Figure FDA0002780539170000039
则:
Figure FDA0002780539170000033
将模糊控制作为一个干扰观测器,求解式(5)中不确定非线性d(t);即如下式:
Figure FDA0002780539170000034
步骤2.2、建立滑模观测器:
仅使用角度位置测量信息重建发射平台全部状态的滑模观测器,通过滑模观测器估计的状态信息实现闭环系统的输出反馈控制;
假设发射平台方位伺服系统状态x2是不可测的,只有x1可测;为了估计发射平台的状态,根据式(5)和式(11),设计如下的滑模观测器:
Figure FDA0002780539170000035
其中
Figure FDA00027805391700000310
为外界干扰与其他估计误差和的估计,λ1和λ2均为滑模观测器的增益,且
Figure FDA00027805391700000311
等效输出注入项
Figure FDA00027805391700000312
Figure FDA00027805391700000313
是通过对信号
Figure FDA00027805391700000314
使用低通滤波器滤波后得到的,该观测器的设计将使对系统状态的估计在有限时间内一个接一个的收敛到真实值;
定理1:存在一组观测器增益λ1、λ2,使得式(5)以及式(12)能观测到状态x1、x2在有限时间内收敛到相应的状态值;
证明:定义观测器误差
Figure FDA0002780539170000047
其中x=[x1 x2]T是每一个通道的状态向量,其中
Figure FDA0002780539170000048
为观测到的状态向量,e=[e1 e2]T;则定义如下的观测器动态误差:
Figure FDA0002780539170000041
其中,
Figure FDA0002780539170000049
表示位置参数θ的自适应估计;
将其简化:
Figure FDA0002780539170000042
将式(14)带入式(13)可得:
Figure FDA0002780539170000043
其中
Figure FDA00027805391700000410
中间变量
Figure FDA00027805391700000411
对于观测器误差e1选择如下的Lyapunov函数:
Figure FDA0002780539170000044
可得:
Figure FDA0002780539170000045
所以当λ1≤-max|e2|,则保证
Figure FDA00027805391700000412
因此观测器误差e1将收敛至滑模面e1=0为了说明该收敛将在有限时间内发生,定义中间函数
Figure FDA00027805391700000413
且增益λ1<-e22,其中正实数ε2>0;有:
Figure FDA0002780539170000046
定义中间函数f(t,W1)=-ε2,则有
Figure FDA00027805391700000414
中间函数
Figure FDA00027805391700000415
则g(0)=W1(e1(0)),则有:
Figure FDA0002780539170000051
使用比较法则引理,推出W1(t)≤g(t),可得:
W1(t)≤W1(e1(0))-ε2t (20)
从该式中看出,由于W1(t)=|e1(t)|,所以|e1|将会在某个时刻T1等于0;因此,在T1时刻之后,状态e1将会收敛到0;由于在滑模面上有
Figure FDA0002780539170000057
求解等效输出注入项
Figure FDA0002780539170000058
在T1时刻之后,有如下误差:
Figure FDA0002780539170000052
对于观测器误差e2选择如下的Lyapunov函数:
Figure FDA0002780539170000053
可得:
Figure FDA0002780539170000054
所以当
Figure FDA0002780539170000059
则保证
Figure FDA00027805391700000510
因观测器误差e2将收敛至滑模面e2=0;
步骤2.3、对于自适应控制,为了避免发射平台方位伺服系统不确定性参数的自适应过程有发散的危险,给参数自适应过程添加不连续映射,定义
Figure FDA00027805391700000511
Figure FDA00027805391700000512
表示估计误差,即
Figure FDA00027805391700000513
一个不连续映射定义如下
Figure FDA0002780539170000055
式中,i=1、2、3、4、5;
设计如下自适应律:
Figure FDA0002780539170000056
式中,Γ为正定对角矩阵,τ为参数自适应函数;
由上式可知,不连续映射使得参数自适应过程是一个受控的过程,其意义在于使得估计的参数不超过预先给定的参数范围;对于任意的参数自适应函数τ,保证下式成立:
P1:
Figure FDA0002780539170000061
P2:
Figure FDA0002780539170000062
步骤2.4、设计自适应鲁棒控制器:
u=ua+us
Figure FDA0002780539170000063
Figure FDA0002780539170000064
其中,ua是模型的前馈补偿项,us为反馈项,us反馈项可以分为线性反馈项us1和非线性鲁棒反馈项us2,k2为正反馈增益。
5.根据权利要求4所述的发射平台的输出反馈自适应鲁棒控制方法,其特征在于,步骤2.4中设计自适应鲁棒控制器,具体如下:
步骤2.4.1、定义x2eq作为x2的虚拟控制输入,定义以下控制误差:
Figure FDA0002780539170000065
其中k1为正反馈增益,z1为位置跟踪误差,z2为速度跟踪误差;由于z1(s)=G(s)z2(s),传递函数G(s)=1/(s+k1)是一个稳定的传递函数,因此让z1趋向于0等价于让z2趋向于0;接下来的目的是让z2趋向于0;根据式(5),得
Figure FDA0002780539170000066
步骤2.4.2、对实际自适应鲁棒控制器u设计控制律以便让z2趋向于0;根据式(29),自适应鲁棒控制器u为:
u=ua+us
Figure FDA0002780539170000067
Figure FDA0002780539170000068
将式(30)带入式(29)得:
Figure FDA0002780539170000071
定义中间变量
Figure FDA0002780539170000078
则上式被改写成:
Figure FDA0002780539170000072
设计参数
Figure FDA0002780539170000079
的自适应律为:
Figure FDA0002780539170000073
上式中Γ1为模型参数θ的自适应速律矩阵,Γ2为可调参数β的自适应速律矩阵;
在式(30)中,设计
Figure FDA00027805391700000710
其中hs为所有误差的上界,即:
Figure FDA0002780539170000074
且参量ε是一个正实数;具有以下特性:
Figure FDA0002780539170000075
6.根据权利要求4所述的发射平台的输出反馈自适应鲁棒控制方法,其特征在于,步骤3中,运用李雅普诺夫稳定性理论进行稳定性证明,在滑模观测器误差存在的情况下得到有界稳定的结果,在滑模观测器误差不存在的情况下,在有限的时间之后运用Barbalat引理可得到系统的全局渐近稳定的结果,具体如下:
定理2:当滑模观测器误差
Figure FDA00027805391700000711
时,根据式(32)和式(33)所设计的控制器能够获得渐近跟踪的性能;
证明:建立如下的Lyapunov函数:
Figure FDA0002780539170000076
对上式进行求导可得:
Figure FDA0002780539170000077
由于模型参数θ和模糊逻辑系统的可调参数β都被认为是一个常量,所以具有以下性质:
Figure FDA00027805391700000712
将式(37)进行化简得到:
Figure FDA0002780539170000081
运用式(25)和式(33)可得:
Figure FDA0002780539170000082
由于k2为一正的增益,故
Figure FDA0002780539170000085
恒小于零,也就是说是
Figure FDA0002780539170000086
恒成立的;根据李雅普诺夫稳定性定理可知,所设计的控制器能够获得渐进跟踪的性能;
定理3:根据式(30)、式(32)和式(35)所设计的控制器能够获得有界稳定的性能;
证明:建立如下的Lyapunov函数:
Figure FDA0002780539170000083
对上式进行求导可得:
Figure FDA0002780539170000084
由于k2为一正的增益,根据李雅普诺夫稳定性定理可知,所设计的控制器能够获得有界稳定的性能。
CN202011280272.3A 2020-11-16 2020-11-16 基于双观测器的发射平台自适应鲁棒输出反馈控制方法 Active CN112558468B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011280272.3A CN112558468B (zh) 2020-11-16 2020-11-16 基于双观测器的发射平台自适应鲁棒输出反馈控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011280272.3A CN112558468B (zh) 2020-11-16 2020-11-16 基于双观测器的发射平台自适应鲁棒输出反馈控制方法

Publications (2)

Publication Number Publication Date
CN112558468A true CN112558468A (zh) 2021-03-26
CN112558468B CN112558468B (zh) 2022-10-14

Family

ID=75042455

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011280272.3A Active CN112558468B (zh) 2020-11-16 2020-11-16 基于双观测器的发射平台自适应鲁棒输出反馈控制方法

Country Status (1)

Country Link
CN (1) CN112558468B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112987560A (zh) * 2021-04-19 2021-06-18 长沙智能驾驶研究院有限公司 滤波器控制方法、装置、设备及计算机存储介质
CN113568310A (zh) * 2021-08-02 2021-10-29 电子科技大学 一种基于模糊自适应滑模的智能车系统干扰补偿方法
CN114619446A (zh) * 2022-03-11 2022-06-14 广东工业大学 基于双观测器的轨迹跟踪控制方法及系统
CN115415251A (zh) * 2022-09-15 2022-12-02 武汉理工大学 一种音圈电机转镜激光清洗系统及其清洗方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104965412A (zh) * 2015-06-29 2015-10-07 南京理工大学 受控化发射平台的自适应鲁棒输出反馈控制方法
CN107765548A (zh) * 2017-08-26 2018-03-06 南京理工大学 基于双观测器的发射平台高精度运动控制方法
CN110673472A (zh) * 2019-09-09 2020-01-10 南京理工大学 基于神经网络补偿死区反演误差的自适应鲁棒控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104965412A (zh) * 2015-06-29 2015-10-07 南京理工大学 受控化发射平台的自适应鲁棒输出反馈控制方法
CN107765548A (zh) * 2017-08-26 2018-03-06 南京理工大学 基于双观测器的发射平台高精度运动控制方法
CN110673472A (zh) * 2019-09-09 2020-01-10 南京理工大学 基于神经网络补偿死区反演误差的自适应鲁棒控制方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112987560A (zh) * 2021-04-19 2021-06-18 长沙智能驾驶研究院有限公司 滤波器控制方法、装置、设备及计算机存储介质
CN112987560B (zh) * 2021-04-19 2021-09-10 长沙智能驾驶研究院有限公司 滤波器控制方法、装置、设备及计算机存储介质
CN113568310A (zh) * 2021-08-02 2021-10-29 电子科技大学 一种基于模糊自适应滑模的智能车系统干扰补偿方法
CN114619446A (zh) * 2022-03-11 2022-06-14 广东工业大学 基于双观测器的轨迹跟踪控制方法及系统
CN115415251A (zh) * 2022-09-15 2022-12-02 武汉理工大学 一种音圈电机转镜激光清洗系统及其清洗方法

Also Published As

Publication number Publication date
CN112558468B (zh) 2022-10-14

Similar Documents

Publication Publication Date Title
CN112558468B (zh) 基于双观测器的发射平台自适应鲁棒输出反馈控制方法
CN112817231B (zh) 一种具有强鲁棒性的机械臂高精度跟踪控制方法
CN107561935B (zh) 基于多层神经网络的电机位置伺服系统摩擦补偿控制方法
CN110673472B (zh) 基于神经网络补偿死区反演误差的自适应鲁棒控制方法
CN110347044B (zh) 一种考虑输出约束的pmsm混沌系统神经网络动态面控制方法
CN104260107B (zh) 一种实现空间机械臂柔性关节齿隙补偿的方法
CN112180729A (zh) 一种机械臂自适应轨迹跟踪控制方法
CN107121932B (zh) 电机伺服系统误差符号积分鲁棒自适应控制方法
CN110221541B (zh) 伺服系统中前馈控制器的前馈系数获取装置、方法
CN110572093A (zh) 基于电机位置伺服系统期望轨迹和干扰补偿的arc控制方法
CN108333928B (zh) 一种基于动态面多直流无刷电机位置协调控制方法
CN111965976B (zh) 基于神经网络观测器的机器人关节滑模控制方法及系统
CN104965412B (zh) 受控化发射平台的自适应鲁棒输出反馈控制方法
CN108406779A (zh) 一种基于未知输入观测器的机械臂运动控制方法
CN105045103A (zh) 一种基于LuGre摩擦模型伺服机械手摩擦补偿控制系统及方法
CN114509949A (zh) 一种机器人预定性能的控制方法
CN108469738A (zh) 一种移动机器人的自适应动力学控制方法
CN107765548B (zh) 基于双观测器的发射平台高精度运动控制方法
CN110829933B (zh) 基于发射平台的神经网络输出反馈自适应鲁棒控制方法
CN107608217B (zh) 基于复合学习的mems陀螺仪模糊滑模控制方法
CN115981162A (zh) 一种基于新型扰动观测器的机器人系统滑模控制轨迹跟踪方法
CN104965413B (zh) 受控化发射平台的摩擦补偿自适应控制方法
CN116382332A (zh) 一种基于ude的战斗机大机动鲁棒飞行控制方法
Luo et al. Event-triggered adaptive fuzzy control for automated vehicle steer-by-wire system with prescribed performance: Theoretical design and experiment implementation
CN117506896A (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