CN115933411A - 一种考虑移动载体的宽频惯性基准单元有限时间控制方法 - Google Patents

一种考虑移动载体的宽频惯性基准单元有限时间控制方法 Download PDF

Info

Publication number
CN115933411A
CN115933411A CN202310041278.2A CN202310041278A CN115933411A CN 115933411 A CN115933411 A CN 115933411A CN 202310041278 A CN202310041278 A CN 202310041278A CN 115933411 A CN115933411 A CN 115933411A
Authority
CN
China
Prior art keywords
reference unit
broadband
finite time
loop
mathematical model
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
CN202310041278.2A
Other languages
English (en)
Other versions
CN115933411B (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.)
Tianjin University
Original Assignee
Tianjin University
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 Tianjin University filed Critical Tianjin University
Priority to CN202310041278.2A priority Critical patent/CN115933411B/zh
Publication of CN115933411A publication Critical patent/CN115933411A/zh
Application granted granted Critical
Publication of CN115933411B publication Critical patent/CN115933411B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Feedback Control In General (AREA)

Abstract

本发明一种考虑移动载体的宽频惯性基准单元有限时间控制方法,包括步骤:将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;解决了宽频惯性基准单元高精度位置控制过程中移动载体引起的位置精度下降的问题。

Description

一种考虑移动载体的宽频惯性基准单元有限时间控制方法
技术领域:
本发明属于空间激光通信领域及伺服控制领域,具体涉及一种考虑移动载体的宽频惯性基准单元有限时间控制方法。
背景技术:
随着航空航天技术的发展,宽频惯性基准单元被广泛应用于天文观测和远距离激光通信等领域中,其主要用来提供一个不受扰动影响、高精度、稳定且快速的偏转角度。然而,随着宽频惯性基准单元的应用场合的不断增加,宽频惯性基准单元在载体逐渐从原来的地基式转变为移动载体式。在载体移动的过程中,提高宽频惯性基准单元对移动载体振动的抑制能力,从而保证宽频惯性基准单元上平台的指向的快速性和精度,考虑移动载体的宽频惯性基准单元有限时间控制是十分必要的。
当载体发生移动时,会在宽频惯性基准单元的基座产生一定的振动,其中大幅值且高频的分量能够通过宽频惯性基准单元下面的设备滤除。因此,宽频惯性基准单元需要抑制的是低频且小幅值的扰动。移动载体引入的基座振动如不针对其加以抑制,将会大大影响宽频惯性基准单元的指向精度。
本发明的考虑移动载体的宽频惯性基准单元有限时间控制方法被控对象宽频惯性基准单元的结构形式与专利[CN108469269A]中的宽频惯性基准稳定单元的结构形式类似。
发明内容:
本发明提供了一种考虑移动载体的宽频惯性基准单元有限时间控制方法,通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;解决了宽频惯性基准单元高精度位置控制过程中移动载体引起的位置精度下降的问题,保证宽频惯性基准单元能够在有限时间内抑制移动载体引入的基座振动并提高角度偏转精度。
为了实现上述目的,本发明采用如下技术方案:
一种考虑移动载体的宽频惯性基准单元有限时间控制方法,包括步骤:
将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;
建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;
根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;
根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;
根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器。
优选的,所述将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,具体包括:
宽频惯性基准单元的二阶数学模型为:
Figure BDA0004050740570000021
Figure BDA0004050740570000022
式中:
2kr2=ka,2cr2=kc,2mcr2+J=ke
Figure BDA0004050740570000031
Figure BDA0004050740570000032
式中:x1(t)=θa(t)为宽频惯性基准单元的绝对偏转的角度,
Figure BDA0004050740570000033
为绝对偏转角速度,χ(t)为宽频惯性基准单元的总体扰动,θb(t)为由移动载体引入的宽频惯性基准单元的基座振动角度,
Figure BDA0004050740570000034
为由移动载体引入宽频惯性基准单元的基座振动角速度,R为音圈电机等效电阻,La为音圈电机等效电感,kb为音圈电机反感应电动势,kd为音圈电机转矩系数,k为音圈电机刚度,c为音圈电机阻尼系数,mc为音圈电机线圈质量,r为音圈电机分布半径,J为音圈电机运动方向的宽频惯性基准单元转动惯量,u(t)为音圈电机驱动电压,i(t)为音圈电机回路电流。优选的,所述建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型,具体包括:
宽频惯性基准单元外环数学模型为:
Figure BDA0004050740570000035
宽频惯性基准单元内环数学模型为:
Figure BDA0004050740570000036
Figure BDA0004050740570000037
式中:uo(t)为外环有限时间控制器;ul(t)为内环有限时间控制器;φ1(t)=x2(t);φ2(t)=χ(t)为扰动的扩张状态,
Figure BDA0004050740570000038
x为一个正常数。
优选的,所述根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值,具体包括:
外环有限时间控制器为:
Figure BDA0004050740570000041
式中,k1、k2、k3、k4、a1为正的可调参数,
Figure BDA0004050740570000042
α2=2a1-1,uo(t)为外环有限时间控制器,v(t)为外环期望信号,e1(t)=v(t)-x1(t);e1(t)为外环跟踪误差。优选的,所述根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动,具体包括:
内环有限时间扩张状态观测器为:
Figure BDA0004050740570000043
Figure BDA0004050740570000044
式中:
z1(t)为对φ1(t)的估计值;z2(t)为对φ2(t)的估计值,
Figure BDA0004050740570000045
为内环有限时间扩张状态观测器对于φ1(t)的估计误差;β1、β2、μ1、a3均为正的可调参数,
Figure BDA0004050740570000046
α4=2α3-1。
优选的,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器,具体包括:
内环有限时间控制器为:
Figure BDA0004050740570000047
其中滑模面s(t)为:
Figure BDA0004050740570000048
式中:
G11(T))=|ξ1(T)|asign(ξ1(T))+ξ1(T)+|ξ1(T)|βsig,n(ξ1(T))
α∈(1-εa,1),β∈(1,1+εβ)
ξ1(t)=uo(t)-x2(t)为内环跟踪误差,l0、l1、εa、εβ、K1为可调正数。
优选的,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器的步骤之后,还包括采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析。
优选的,所述采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析,具体包括:
对外环有限时间控制器设计李亚普诺夫函数方程如下:
Figure BDA0004050740570000051
式中:
Figure BDA0004050740570000052
Figure BDA0004050740570000053
Figure BDA0004050740570000054
对李亚普诺夫函数方程
Figure BDA0004050740570000055
求导:
Figure BDA0004050740570000056
式中:
Figure BDA0004050740570000061
Figure BDA0004050740570000062
Figure BDA0004050740570000063
Figure BDA0004050740570000064
其中:H1、H2均为赫尔维兹矩阵,P1为对称正定矩阵,Q1、Q2均为Hermite矩阵;λmin(·)表示矩阵的最小特征值,λmax(·)表示矩阵的最大特征值;||·||表示矩阵的2-范数;
由此可得,外环有限时间控制器在有限时间内稳定。
优选的,所述采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析,具体包括:
对内环有限时间扩张状态观测器设计李亚普诺夫函数方程如下:
v2(Ξ(t))=ΞT(t)P2Ξ(t)
式中:
Figure BDA0004050740570000065
对李亚普诺夫函数方程v2(Ξ(t))求导:
Figure BDA0004050740570000071
式中:
Figure BDA0004050740570000072
Figure BDA0004050740570000073
Figure BDA0004050740570000074
Figure BDA0004050740570000075
其中,H3、H4均为赫尔维兹矩阵,P2为对称正定矩阵,Q3、Q4均为Hermite矩阵;
由此可得,内环有限时间扩张状态观测器在有限时间内稳定。
优选的,所述采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
为证明内环误差ξ1(t)能在有限时间内收敛到滑模面s(t),设计滑模面设计
Figure BDA0004050740570000076
设计李亚普诺夫函数方程如下:
Figure BDA0004050740570000077
对李亚普诺夫函数方程v3(s(t))求导:
Figure BDA0004050740570000081
式中:
Figure BDA0004050740570000082
Figure BDA0004050740570000083
Figure BDA0004050740570000084
收敛后界的绝对值的上界;得到
Figure BDA0004050740570000085
由此可得,内环误差ξ1(t)在有限时间内收敛到滑模面s(t);
证明内环误差ξ1(t)能在有限时间内沿着滑模面s(t)收敛到零:
基于
Figure BDA0004050740570000086
得:
Figure BDA0004050740570000087
由此可得,内环误差ξ1(t)在有限时间内沿着滑模面s(t)收敛到零。
本发明的有益效果在于:
1.本发明通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;解决了宽频惯性基准单元高精度位置控制过程中移动载体引起的位置精度下降的问题,保证宽频惯性基准单元能够在有限时间内抑制移动载体引入的基座振动并提高角度偏转精度。
2.本发明通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,降低了移动载体引入的基座振动对宽频惯性基准单元位置控制精度的影响,鲁棒性提高。
3.本发明双闭环有限时间控制方法易于工程实现,采用多个李亚普诺夫函数证明了所设计内环扩张状态观测器和内外环控制器的有限时间稳定性,并证明了整个双闭环***的有限时间稳定性。
附图说明:
图1为本发明的一种考虑移动载体的宽频惯性基准单元有限时间控制原理框图。
图2为本发明的设计流程图。
图3和图4为本发明的宽频惯性基准单元在不同振动下的位置外环曲线图。
图5和图6为本发明的宽频惯性基准单元在不同振动下的速度内环曲线图。
具体实施方式:
为使本发明的目的更加明确,技术方案更加清晰,以下结合附图和具体实施例对本发明进行详细说明。
图1所示为本发明控制原理框图,表明了本发明所述的一种考虑移动载体的宽频惯性基准单元有限时间控制方法。
下面结合图1-6对本发明所述控制算法进行详细描述,但不作为对本发明的限定。
一种考虑移动载体的宽频惯性基准单元有限时间控制方法,包括步骤:
S100、将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;
S200、建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;
S300、根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;
S400、根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;
S500、根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器;
S600、采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析;
S700、对整个双闭环***进行稳定性分析。
本实施例中,S100、将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,具体包括:
宽频惯性基准单元的二阶数学模型为:
Figure BDA0004050740570000101
Figure BDA0004050740570000102
式中:
2kr2=ka,2cr2=kc,2mcr2+J=ke
Figure BDA0004050740570000103
Figure BDA0004050740570000104
式中:x1(t)=θa(t)为宽频惯性基准单元的绝对偏转的角度,
Figure BDA0004050740570000105
为绝对偏转角速度,χ(t)为宽频惯性基准单元的总体扰动,θb(t)为由移动载体引入的宽频惯性基准单元的基座振动角度,
Figure BDA0004050740570000106
为由移动载体引入宽频惯性基准单元的基座振动角速度,R为音圈电机等效电阻,La为音圈电机等效电感,kb为音圈电机反感应电动势,kd为音圈电机转矩系数,k为音圈电机刚度,c为音圈电机阻尼系数,mc为音圈电机线圈质量,r为音圈电机分布半径,J为音圈电机运动方向的宽频惯性基准单元转动惯量,u(t)为音圈电机驱动电压,i(t)为音圈电机回路电流。本实施例中,S200、建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型,具体包括:
宽频惯性基准单元外环数学模型为:
Figure BDA0004050740570000111
宽频惯性基准单元内环数学模型为:
Figure BDA0004050740570000112
Figure BDA0004050740570000113
式中:uo(t)为外环有限时间控制器;ul(t)为内环有限时间控制器;φ1(t)=x2(t);φ2(t)=χ(t)为扰动的扩张状态,
Figure BDA0004050740570000114
x为一个正常数,即:宽频惯性基准单元所受到的扰动是有界的。
本实施例中,S300、根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值,具体包括:
外环有限时间控制器为:
Figure BDA0004050740570000115
式中,k1、k2、k3、k4、a1为正的可调参数,
Figure BDA0004050740570000116
α2=2a1-1,uo(t)为外环有限时间控制器,v(t)为外环期望信号,e1(t)=v(t)-x1(t);e1(t)为外环跟踪误差。本实施例中,S400、根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动,具体包括:
内环有限时间扩张状态观测器为:
Figure BDA0004050740570000117
Figure BDA0004050740570000118
式中:
z1(t)为对φ1(t)的估计值;z2(t)为对φ2(t)的估计值,
Figure BDA0004050740570000121
为内环有限时间扩张状态观测器对于φ1(t)的估计误差;β1、β2、μ1、a3均为正的可调参数,
Figure BDA0004050740570000122
a4=2a3-1。
本实施例中,S500、根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器,具体包括:
内环有限时间控制器为:
Figure BDA0004050740570000123
其中滑模面s(t)为:
Figure BDA0004050740570000124
式中:
G11(T))=|ξ1(T)|asign(ξ1(T))+ξ1(T)+|ξ1(T)|βsign(ξ1(T))
α∈(1-εa,1),β∈(1,1+εβ)
ξ1(t)=uo(t)-x2(t)为内环跟踪误差,l0、l1、εa、εβ、K1为可调正数,另外,εa、εβ很小。
本实施例中,S600、采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
S601、采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析,具体包括:
对外环有限时间控制器设计李亚普诺夫函数方程如下:
Figure BDA0004050740570000125
式中:
Figure BDA0004050740570000131
Figure BDA0004050740570000132
Figure BDA0004050740570000133
对李亚普诺夫函数方程
Figure BDA0004050740570000134
求导:
Figure BDA0004050740570000135
式中:
Figure BDA0004050740570000136
Figure BDA0004050740570000137
Figure BDA0004050740570000138
Figure BDA0004050740570000139
其中:H1、H2均为赫尔维兹矩阵,P1为对称正定矩阵,Q1、Q2均为Hermite矩阵;λmin(·)表示矩阵的最小特征值,λmax(·)表示矩阵的最大特征值;||·||表示矩阵的2-范数;综上,可以证明所设计的外环控制器能够在有限时间内稳定。
由此可得,外环有限时间控制器在有限时间内稳定。
S602、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析,具体包括:
对内环有限时间扩张状态观测器设计李亚普诺夫函数方程如下:
v2(Ξ(t))=ΞT(t)P2Ξ(t)
式中:
Figure BDA0004050740570000141
对李亚普诺夫函数方程v2(Ξ(t))求导:
Figure BDA0004050740570000142
式中:
Figure BDA0004050740570000143
Figure BDA0004050740570000144
Figure BDA0004050740570000145
Figure BDA0004050740570000146
其中,H3、H4均为赫尔维兹矩阵,P2为对称正定矩阵,Q3、Q4均为Hermite矩阵;综上,可以证明所设计的内环扩张状态观测器能够在有限时间内稳定到界内。
由此可得,内环有限时间扩张状态观测器在有限时间内稳定。
S603、采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
对于内环有限时间控制器的有限时间稳定性进行证明分为两步:
第一步:为证明内环误差ξ1(t)能在有限时间内收敛到滑模面s(t),设计滑模面设计
Figure BDA0004050740570000151
设计李亚普诺夫函数方程如下:
Figure BDA0004050740570000152
对李亚普诺夫函数方程v3(s(t))求导:
Figure BDA0004050740570000153
式中:
Figure BDA0004050740570000154
Figure BDA0004050740570000155
Figure BDA0004050740570000156
收敛后界的绝对值的上界;得到
Figure BDA0004050740570000157
综上可得,内环误差ξ1(t)能在有限时间内收敛到滑模面s(t)。
第二步:证明内环误差ξ1(t)能在有限时间内沿着滑模面s(t)收敛到零:
在第一步的基础上,基于
Figure BDA0004050740570000159
得:
Figure BDA0004050740570000158
根据相关知识,该一阶***能在有限时间内稳定。即:内环误差ξ1(t)能够在有限时间内沿着滑模面s(t)收敛到零。
由此可得,内环误差ξ1(t)在有限时间内沿着滑模面s(t)收敛到零。
综上,在外环有限时间控制器、内环有限时间扩张状态观测器和内环有限时间控制器的作用下,内外环子***能够在有限时间内稳定。
本实施例中,S700、对整个双闭环***进行稳定性分析,具体包括:
可以把该宽频惯性基准单元的误差***视为如下的串级***:
Figure BDA0004050740570000161
Figure BDA0004050740570000162
式中:
Figure BDA0004050740570000163
Figure BDA0004050740570000164
根据,串级***有限时间稳定性证明的相关知识,在两个子***都能在有限时间内稳定的前提下,对于任何有界的ξ1(t),设计一个连续且严格递增的函数Bξ(t,e1(t))如下:
Figure BDA0004050740570000165
式中:
Figure BDA0004050740570000166
对函数Bξ(t,e1(t))关于时间t求导得:
Figure BDA0004050740570000167
显然
Figure BDA0004050740570000168
则上式等效于
Figure BDA0004050740570000169
式中:
ρ1=k1k2+k1+(k4+1)b,ρ2=k1+b+Δ
另外,Ω(Bξ(t,e1(t)))满足Ω(a)≥a,
Figure BDA0004050740570000171
Figure BDA0004050740570000172
由此可得,整个双闭环***能够在有限时间内稳定。因此,本发明一种考虑移动载体的宽频惯性基准单元有限时间控制方法是有效的。
为验证本发明提出的一种考虑移动载体的宽频惯性基准单元有限时间控制方法的有效性,给出其实验验证,说明考虑移动载体的宽频惯性基准单元有限时间控制方法是有效的,具体如下:
宽频惯性基准单元初始偏转角度为Oarcsec,宽频惯性基准单元底座与振动台固定,通过控制振动台来模拟实际环境中的移动载体的振动。宽频惯性基准单元装有外置电涡流位移传感器、音圈电机、MEMS陀螺仪并配有相应硬件工控机。
控制目标设置为:
设定的振动信号有两种,峰峰值和频率分别为:PPV=92arcsec、F=1Hz;PPV=52arcsec、F=2Hz。参考输入信号为Oarcsec。
在不同振动下时,宽频惯性基准单元外环实验曲线如图3和图4所示。其中θb(t)表示峰峰值和频率分别为PPV=92arcsec、F=1Hz;PPV=52arcsec、F=2Hz的两个振动信号,v0(t)表示参考输入信号:Oarcsec,x1(t)表示分别双闭环有限时间控制算法在PPV=92arcsec、F=1Hz;PPV=52arcsec、F=2Hz下的输出角度信号,xD(t)为双环PID控制算法PPV=92arcsec、F=1Hz;PPV=52arcsec、F=2Hz下的输出角度信号。从图3和图4中可以看出,在两种不同的振动情况下,所提出的双闭环有限时间控制算法相比于双环PID控制算法对于振动有更好的抑制效果。
在PPV=92arcsec、F=1Hz;PPV=52arcsec、F=2Hz两组不同振动信号下,速度内环曲线如图5和图6所示,其中φ1(t)输出角速度信号,z1(t)表示在内环有限时间扩张状态观测器对输出角速度的估计曲线。从图5和图6中可以看出,在四个不同振动下,内环有限时间扩张状态观测器均可以较快地输出准确且稳定的输出角速度估计值。
根据上述说明书的揭示和教导,本发明所属领域的技术人员还能够对上述实施方式进行变更和修改。因此,本发明并不局限于上述的具体实施方式,凡是本领域技术人员在本发明的基础上所作出的任何显而易见的改进、替换或变型均属于本发明的保护范围。

Claims (10)

1.一种考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,包括步骤:
将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;
建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;
根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;
根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;
根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器。
2.根据权利要求1所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,具体包括:
宽频惯性基准单元的二阶数学模型为:
Figure FDA0004050740560000011
Figure FDA0004050740560000013
式中:
Figure FDA0004050740560000012
式中:x1(t)=θa(t)为宽频惯性基准单元的绝对偏转的角度,
Figure FDA0004050740560000021
为绝对偏转角速度,χ(t)为宽频惯性基准单元的总体扰动,θb(t)为由移动载体引入的宽频惯性基准单元的基座振动角度,
Figure FDA0004050740560000022
为由移动载体引入宽频惯性基准单元的基座振动角速度,R为音圈电机等效电阻,La为音圈电机等效电感,kb为音圈电机反感应电动势,kd为音圈电机转矩系数,k为音圈电机刚度,c为音圈电机阻尼系数,mc为音圈电机线圈质量,r为音圈电机分布半径,J为音圈电机运动方向的宽频惯性基准单元转动惯量,u(t)为音圈电机驱动电压,i(t)为音圈电机回路电流。
3.根据权利要求1所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型,具体包括:
宽频惯性基准单元外环数学模型为:
Figure FDA0004050740560000023
宽频惯性基准单元内环数学模型为:
Figure FDA0004050740560000024
式中:uo(t)为外环有限时间控制器;u1(t)为内环有限时间控制器;φ1(t)=x2(t);φ2(t)=χ(t)为扰动的扩张状态,
Figure FDA0004050740560000025
x为一个正常数。
4.根据权利要求3所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值,具体包括:
外环有限时间控制器为:
Figure FDA0004050740560000031
式中,k1、k2、k3、k4、a1为正的可调参数,
Figure FDA0004050740560000032
α2=2a1-1,uo(t)为外环有限时间控制器,v(t)为外环期望信号,e1(t)=v(t)-x1(t);e1(t)为外环跟踪误差。
5.根据权利要求3所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动,具体包括:
内环有限时间扩张状态观测器为:
Figure FDA0004050740560000033
式中:
z1(t)为对φ1(t)的估计值;z2(t)为对φ2(t)的估计值,ψ1(t)=z1(t)-φ1(t)为内环有限时间扩张状态观测器对于φ1(t)的估计误差;β1、β2、μ1、a3均为正的可调参数,
Figure FDA0004050740560000034
a4=2a3-1。
6.根据权利要求5所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器,具体包括:
内环有限时间控制器为:
Figure FDA0004050740560000035
其中滑模面s(t)为:
Figure FDA0004050740560000036
式中:
G11(T))=|ξ1(T)|asign(ξ1(T))+ξ1(T)+|ξ1(T)|βsign(ξ1(T))
α∈(1-εa,1),β∈(1,1+εβ)
ξ1(t)=uo(t)-x2(t)为内环跟踪误差,l0、l1、εa、εβ、K1为可调正数。
7.根据权利要求1所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器的步骤之后,还包括采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析。
8.根据权利要求7所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析,具体包括:
对外环有限时间控制器设计李亚普诺夫函数方程如下:
Figure FDA0004050740560000041
式中:
Figure FDA0004050740560000042
Figure FDA0004050740560000043
Figure FDA0004050740560000044
对李亚普诺夫函数方程
Figure FDA0004050740560000045
求导:
Figure FDA0004050740560000051
式中:
Figure FDA0004050740560000052
Figure FDA0004050740560000053
Figure FDA0004050740560000054
Figure FDA0004050740560000055
其中:H1、H2均为赫尔维兹矩阵,P1为对称正定矩阵,Q1、Q2均为Hermite矩阵;λmin(·)表示矩阵的最小特征值,λmax(·)表示矩阵的最大特征值;||·||表示矩阵的2-范数;
由此可得,外环有限时间控制器在有限时间内稳定。
9.根据权利要求7所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析,具体包括:
对内环有限时间扩张状态观测器设计李亚普诺夫函数方程如下:
Figure FDA0004050740560000056
式中:
Figure FDA0004050740560000061
对李亚普诺夫函数方程
Figure FDA0004050740560000068
求导:
Figure FDA0004050740560000062
式中:
Figure FDA0004050740560000063
Figure FDA0004050740560000064
Figure FDA0004050740560000065
Figure FDA0004050740560000066
其中,H3、H4均为赫尔维兹矩阵,P2为对称正定矩阵,Q3、Q4均为Hermite矩阵;
由此可得,内环有限时间扩张状态观测器在有限时间内稳定。
10.根据权利要求7所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
为证明内环误差ξ1(t)能在有限时间内收敛到滑模面s(t),设计滑模面设计
Figure FDA0004050740560000067
设计李亚普诺夫函数方程如下:
Figure FDA0004050740560000071
对李亚普诺夫函数方程v2(s(t))求导:
Figure FDA0004050740560000072
式中:
Figure FDA0004050740560000073
Figure FDA0004050740560000074
为ψ2(t)收敛后界的绝对值的上界;得到
Figure FDA0004050740560000075
由此可得,内环误差ξ1(t)在有限时间内收敛到滑模面s(t);
证明内环误差ξ1(t)能在有限时间内沿着滑模面s(t)收敛到零:
基于
Figure FDA0004050740560000076
得:
Figure FDA0004050740560000077
由此可得,内环误差ξ1(t)在有限时间内沿着滑模面s(t)收敛到零。
CN202310041278.2A 2023-01-13 2023-01-13 一种考虑移动载体的宽频惯性基准单元有限时间控制方法 Active CN115933411B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310041278.2A CN115933411B (zh) 2023-01-13 2023-01-13 一种考虑移动载体的宽频惯性基准单元有限时间控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310041278.2A CN115933411B (zh) 2023-01-13 2023-01-13 一种考虑移动载体的宽频惯性基准单元有限时间控制方法

Publications (2)

Publication Number Publication Date
CN115933411A true CN115933411A (zh) 2023-04-07
CN115933411B CN115933411B (zh) 2023-11-10

Family

ID=86700940

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310041278.2A Active CN115933411B (zh) 2023-01-13 2023-01-13 一种考虑移动载体的宽频惯性基准单元有限时间控制方法

Country Status (1)

Country Link
CN (1) CN115933411B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9663252B1 (en) * 2016-12-07 2017-05-30 Beihang University Method for attitude controlling based on finite time friction estimation for flexible spacecraft
CN110376882A (zh) * 2019-04-28 2019-10-25 天津大学 基于有限时间扩张状态观测器的预定性能控制方法
CN113219838A (zh) * 2021-06-08 2021-08-06 北京航空航天大学 一种基于自适应时变带宽观测器的三轴惯性稳定平台高精度控制方法
CN114326399A (zh) * 2021-12-28 2022-04-12 天津大学 一种宽频惯性基准单元有限时间抗干扰控制方法
CN115202216A (zh) * 2022-09-14 2022-10-18 沈阳工业大学 考虑输入约束的机械臂抗干扰有限时间控制方法
CN115268475A (zh) * 2022-08-09 2022-11-01 哈尔滨工程大学 基于有限时间扰动观测器的机器鱼精确地形跟踪控制方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9663252B1 (en) * 2016-12-07 2017-05-30 Beihang University Method for attitude controlling based on finite time friction estimation for flexible spacecraft
CN110376882A (zh) * 2019-04-28 2019-10-25 天津大学 基于有限时间扩张状态观测器的预定性能控制方法
CN113219838A (zh) * 2021-06-08 2021-08-06 北京航空航天大学 一种基于自适应时变带宽观测器的三轴惯性稳定平台高精度控制方法
CN114326399A (zh) * 2021-12-28 2022-04-12 天津大学 一种宽频惯性基准单元有限时间抗干扰控制方法
CN115268475A (zh) * 2022-08-09 2022-11-01 哈尔滨工程大学 基于有限时间扰动观测器的机器鱼精确地形跟踪控制方法
CN115202216A (zh) * 2022-09-14 2022-10-18 沈阳工业大学 考虑输入约束的机械臂抗干扰有限时间控制方法

Also Published As

Publication number Publication date
CN115933411B (zh) 2023-11-10

Similar Documents

Publication Publication Date Title
Shao et al. Neural adaptive control for MEMS gyroscope with full-state constraints and quantized input
CN108897226B (zh) 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法
Chen et al. Adaptive fuzzy inverse trajectory tracking control of underactuated underwater vehicle with uncertainties
CN107607101B (zh) 基于干扰观测器的mems陀螺滑模控制方法
CN107831655B (zh) 微陀螺仪的分数阶自适应反演模糊滑模控制方法
CN110716506B (zh) 一种基于混合滑模控制的伺服***位置跟踪控制方法
Peng et al. Integrated PID-based sliding mode state estimation and control for piezoelectric actuators
Fei Robust adaptive vibration tracking control for a micro-electro-mechanical systems vibratory gyroscope with bound estimation
CN108227504B (zh) 微陀螺分数阶自适应模糊神经反演终端滑模控制方法
Huang et al. Designing active flutter suppression for high-dimensional aeroelastic systems involving a control delay
CN107607102B (zh) 基于干扰观测器的mems陀螺滑模抖振抑制方法
CN107678282B (zh) 考虑未知动力学和外部干扰的mems陀螺智能控制方法
Liu et al. An active disturbance rejection control for hysteresis compensation based on neural networks adaptive control
CN114326399B (zh) 一种宽频惯性基准单元有限时间抗干扰控制方法
CN112363524B (zh) 一种基于自适应增益扰动补偿的再入飞行器姿态控制方法
Chen et al. Actuator backlash compensation and accurate parameter estimation for active vibration isolation system
Qiao et al. Adaptive control of missile attitude based on BP–ADRC
JP5445887B2 (ja) 磁気軸受装置
CN107608217B (zh) 基于复合学习的mems陀螺仪模糊滑模控制方法
Shi et al. Active vibration isolation of a maglev inertially stabilized platform based on an improved linear extended state observer
CN107870566B (zh) 基于平行估计复合学习的mems陀螺仪快速启动方法
CN115933411B (zh) 一种考虑移动载体的宽频惯性基准单元有限时间控制方法
CN107608216B (zh) 基于平行估计模型的mems陀螺仪复合学习控制方法
Ben Tarla et al. Robustifying hierarchical sliding mode control for active vibration suppression of a flexible manipulator using integral sliding mode control
Butt et al. Multi-variable flatness-based control of a helicopter with two degrees of freedom

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