CN115933411B - 一种考虑移动载体的宽频惯性基准单元有限时间控制方法 - Google Patents
一种考虑移动载体的宽频惯性基准单元有限时间控制方法 Download PDFInfo
- Publication number
- CN115933411B CN115933411B CN202310041278.2A CN202310041278A CN115933411B CN 115933411 B CN115933411 B CN 115933411B CN 202310041278 A CN202310041278 A CN 202310041278A CN 115933411 B CN115933411 B CN 115933411B
- Authority
- CN
- China
- Prior art keywords
- reference unit
- inertial reference
- broadband
- mathematical model
- finite time
- 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
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000013178 mathematical model Methods 0.000 claims abstract description 63
- 239000011159 matrix material Substances 0.000 claims description 21
- 238000013461 design Methods 0.000 claims description 15
- 238000013016 damping Methods 0.000 claims description 4
- WNRQPCUGRUFHED-DETKDSODSA-N humalog Chemical group C([C@H](NC(=O)[C@H](CC(C)C)NC(=O)[C@H](CO)NC(=O)[C@H](CS)NC(=O)[C@H]([C@@H](C)CC)NC(=O)[C@H](CO)NC(=O)[C@H]([C@@H](C)O)NC(=O)[C@H](CS)NC(=O)[C@H](CS)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@H](CCC(O)=O)NC(=O)[C@H](C(C)C)NC(=O)[C@@H](NC(=O)CN)[C@@H](C)CC)C(=O)N[C@@H](CCC(N)=O)C(=O)N[C@@H](CC(C)C)C(=O)N[C@@H](CCC(O)=O)C(=O)N[C@@H](CC(N)=O)C(=O)N[C@@H](CC=1C=CC(O)=CC=1)C(=O)N[C@@H](CS)C(=O)N[C@@H](CC(N)=O)C(O)=O)C1=CC=C(O)C=C1.C([C@@H](C(=O)N[C@@H](CC(C)C)C(=O)N[C@H](C(=O)N[C@@H](CCC(O)=O)C(=O)N[C@@H](C)C(=O)N[C@@H](CC(C)C)C(=O)N[C@@H](CC=1C=CC(O)=CC=1)C(=O)N[C@@H](CC(C)C)C(=O)N[C@@H](C(C)C)C(=O)N[C@@H](CS)C(=O)NCC(=O)N[C@@H](CCC(O)=O)C(=O)N[C@@H](CCCNC(N)=N)C(=O)NCC(=O)N[C@@H](CC=1C=CC=CC=1)C(=O)N[C@@H](CC=1C=CC=CC=1)C(=O)N[C@@H](CC=1C=CC(O)=CC=1)C(=O)N[C@@H]([C@@H](C)O)C(=O)N[C@@H](CCCCN)C(=O)N1[C@@H](CCC1)C(=O)N[C@@H]([C@@H](C)O)C(O)=O)C(C)C)NC(=O)[C@H](CO)NC(=O)CNC(=O)[C@H](CS)NC(=O)[C@H](CC(C)C)NC(=O)[C@H](CC=1NC=NC=1)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@H](CC(N)=O)NC(=O)[C@@H](NC(=O)[C@@H](N)CC=1C=CC=CC=1)C(C)C)C1=CN=CN1 WNRQPCUGRUFHED-DETKDSODSA-N 0.000 claims description 4
- 230000007423 decrease Effects 0.000 abstract description 3
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000009977 dual effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000006049 ring expansion reaction Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明一种考虑移动载体的宽频惯性基准单元有限时间控制方法,包括步骤:将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;解决了宽频惯性基准单元高精度位置控制过程中移动载体引起的位置精度下降的问题。
Description
技术领域:
本发明属于空间激光通信领域及伺服控制领域,具体涉及一种考虑移动载体的宽频惯性基准单元有限时间控制方法。
背景技术:
随着航空航天技术的发展,宽频惯性基准单元被广泛应用于天文观测和远距离激光通信等领域中,其主要用来提供一个不受扰动影响、高精度、稳定且快速的偏转角度。然而,随着宽频惯性基准单元的应用场合的不断增加,宽频惯性基准单元在载体逐渐从原来的地基式转变为移动载体式。在载体移动的过程中,提高宽频惯性基准单元对移动载体振动的抑制能力,从而保证宽频惯性基准单元上平台的指向的快速性和精度,考虑移动载体的宽频惯性基准单元有限时间控制是十分必要的。
当载体发生移动时,会在宽频惯性基准单元的基座产生一定的振动,其中大幅值且高频的分量能够通过宽频惯性基准单元下面的设备滤除。因此,宽频惯性基准单元需要抑制的是低频且小幅值的扰动。移动载体引入的基座振动如不针对其加以抑制,将会大大影响宽频惯性基准单元的指向精度。
本发明的考虑移动载体的宽频惯性基准单元有限时间控制方法被控对象宽频惯性基准单元的结构形式与专利[CN108469269A]中的宽频惯性基准稳定单元的结构形式类似。
发明内容:
本发明提供了一种考虑移动载体的宽频惯性基准单元有限时间控制方法,通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;解决了宽频惯性基准单元高精度位置控制过程中移动载体引起的位置精度下降的问题,保证宽频惯性基准单元能够在有限时间内抑制移动载体引入的基座振动并提高角度偏转精度。
为了实现上述目的,本发明采用如下技术方案:
一种考虑移动载体的宽频惯性基准单元有限时间控制方法,包括步骤:
将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;
建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;
根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;
根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;
根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器。
优选的,所述将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,具体包括:
宽频惯性基准单元的二阶数学模型为:
式中:
2kr2=ka,2cr2=kc,2mcr2+J=ke
式中:x1(t)=θa(t)为宽频惯性基准单元的绝对偏转的角度,为绝对偏转角速度,χ(t)为宽频惯性基准单元的总体扰动,θb(t)为由移动载体引入的宽频惯性基准单元的基座振动角度,/>为由移动载体引入宽频惯性基准单元的基座振动角速度,R为音圈电机等效电阻,La为音圈电机等效电感,kb为音圈电机反感应电动势,kd为音圈电机转矩系数,k为音圈电机刚度,c为音圈电机阻尼系数,mc为音圈电机线圈质量,r为音圈电机分布半径,J为音圈电机运动方向的宽频惯性基准单元转动惯量,u(t)为音圈电机驱动电压,i(t)为音圈电机回路电流。优选的,所述建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型,具体包括:
宽频惯性基准单元外环数学模型为:
宽频惯性基准单元内环数学模型为:
式中:uo(t)为外环有限时间控制器;ul(t)为内环有限时间控制器;φ1(t)=x2(t);φ2(t)=χ(t)为扰动的扩张状态,x为一个正常数。
优选的,所述根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值,具体包括:
外环有限时间控制器为:
式中,k1、k2、k3、k4、a1为正的可调参数,α2=2a1-1,uo(t)为外环有限时间控制器,v(t)为外环期望信号,e1(t)=v(t)-x1(t);e1(t)为外环跟踪误差。优选的,所述根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动,具体包括:
内环有限时间扩张状态观测器为:
式中:
z1(t)为对φ1(t)的估计值;z2(t)为对φ2(t)的估计值,为内环有限时间扩张状态观测器对于φ1(t)的估计误差;β1、β2、μ1、a3均为正的可调参数,/>α4=2α3-1。
优选的,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器,具体包括:
内环有限时间控制器为:
其中滑模面s(t)为:
式中:
G1(ξ1(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为可调正数。
优选的,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器的步骤之后,还包括采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析。
优选的,所述采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析,具体包括:
对外环有限时间控制器设计李亚普诺夫函数方程如下:
式中:
对李亚普诺夫函数方程求导:
式中:
其中:H1、H2均为赫尔维兹矩阵,P1为对称正定矩阵,Q1、Q2均为Hermite矩阵;λmin(·)表示矩阵的最小特征值,λmax(·)表示矩阵的最大特征值;||·||表示矩阵的2-范数;
由此可得,外环有限时间控制器在有限时间内稳定。
优选的,所述采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析,具体包括:
对内环有限时间扩张状态观测器设计李亚普诺夫函数方程如下:
v2(Ξ(t))=ΞT(t)P2Ξ(t)
式中:
对李亚普诺夫函数方程v2(Ξ(t))求导:
式中:
其中,H3、H4均为赫尔维兹矩阵,P2为对称正定矩阵,Q3、Q4均为Hermite矩阵;
由此可得,内环有限时间扩张状态观测器在有限时间内稳定。
优选的,所述采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
为证明内环误差ξ1(t)能在有限时间内收敛到滑模面s(t),设计滑模面设计设计李亚普诺夫函数方程如下:
对李亚普诺夫函数方程v3(s(t))求导:
式中:
且/>为/>收敛后界的绝对值的上界;得到/>
由此可得,内环误差ξ1(t)在有限时间内收敛到滑模面s(t);
证明内环误差ξ1(t)能在有限时间内沿着滑模面s(t)收敛到零:
基于得:
由此可得,内环误差ξ1(t)在有限时间内沿着滑模面s(t)收敛到零。
本发明的有益效果在于:
1.本发明通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;解决了宽频惯性基准单元高精度位置控制过程中移动载体引起的位置精度下降的问题,保证宽频惯性基准单元能够在有限时间内抑制移动载体引入的基座振动并提高角度偏转精度。
2.本发明通过将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,降低了移动载体引入的基座振动对宽频惯性基准单元位置控制精度的影响,鲁棒性提高。
3.本发明双闭环有限时间控制方法易于工程实现,采用多个李亚普诺夫函数证明了所设计内环扩张状态观测器和内外环控制器的有限时间稳定性,并证明了整个双闭环系统的有限时间稳定性。
附图说明:
图1为本发明的一种考虑移动载体的宽频惯性基准单元有限时间控制原理框图。
图2为本发明的设计流程图。
图3和图4为本发明的宽频惯性基准单元在不同振动下的位置外环曲线图。
图5和图6为本发明的宽频惯性基准单元在不同振动下的速度内环曲线图。
具体实施方式:
为使本发明的目的更加明确,技术方案更加清晰,以下结合附图和具体实施例对本发明进行详细说明。
图1所示为本发明控制原理框图,表明了本发明所述的一种考虑移动载体的宽频惯性基准单元有限时间控制方法。
下面结合图1-6对本发明所述控制算法进行详细描述,但不作为对本发明的限定。
一种考虑移动载体的宽频惯性基准单元有限时间控制方法,包括步骤:
S100、将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;
S200、建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;
S300、根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;
S400、根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;
S500、根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器;
S600、采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析;
S700、对整个双闭环系统进行稳定性分析。
本实施例中,S100、将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,具体包括:
宽频惯性基准单元的二阶数学模型为:
式中:
2kr2=ka,2cr2=kc,2mcr2+J=ke
式中:x1(t)=θa(t)为宽频惯性基准单元的绝对偏转的角度,为绝对偏转角速度,χ(t)为宽频惯性基准单元的总体扰动,θb(t)为由移动载体引入的宽频惯性基准单元的基座振动角度,/>为由移动载体引入宽频惯性基准单元的基座振动角速度,R为音圈电机等效电阻,La为音圈电机等效电感,kb为音圈电机反感应电动势,kd为音圈电机转矩系数,k为音圈电机刚度,c为音圈电机阻尼系数,mc为音圈电机线圈质量,r为音圈电机分布半径,J为音圈电机运动方向的宽频惯性基准单元转动惯量,u(t)为音圈电机驱动电压,i(t)为音圈电机回路电流。本实施例中,S200、建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型,具体包括:
宽频惯性基准单元外环数学模型为:
宽频惯性基准单元内环数学模型为:
式中:uo(t)为外环有限时间控制器;ul(t)为内环有限时间控制器;φ1(t)=x2(t);φ2(t)=χ(t)为扰动的扩张状态,x为一个正常数,即:宽频惯性基准单元所受到的扰动是有界的。
本实施例中,S300、根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值,具体包括:
外环有限时间控制器为:
式中,k1、k2、k3、k4、a1为正的可调参数,α2=2a1-1,uo(t)为外环有限时间控制器,v(t)为外环期望信号,e1(t)=v(t)-x1(t);e1(t)为外环跟踪误差。本实施例中,S400、根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动,具体包括:
内环有限时间扩张状态观测器为:
式中:
z1(t)为对φ1(t)的估计值;z2(t)为对φ2(t)的估计值,为内环有限时间扩张状态观测器对于φ1(t)的估计误差;β1、β2、μ1、a3均为正的可调参数,/>a4=2a3-1。
本实施例中,S500、根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器,具体包括:
内环有限时间控制器为:
其中滑模面s(t)为:
式中:
G1(ξ1(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、采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析,具体包括:
对外环有限时间控制器设计李亚普诺夫函数方程如下:
式中:
对李亚普诺夫函数方程求导:
式中:
其中:H1、H2均为赫尔维兹矩阵,P1为对称正定矩阵,Q1、Q2均为Hermite矩阵;λmin(·)表示矩阵的最小特征值,λmax(·)表示矩阵的最大特征值;||·||表示矩阵的2-范数;综上,可以证明所设计的外环控制器能够在有限时间内稳定。
由此可得,外环有限时间控制器在有限时间内稳定。
S602、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析,具体包括:
对内环有限时间扩张状态观测器设计李亚普诺夫函数方程如下:
v2(Ξ(t))=ΞT(t)P2Ξ(t)
式中:
对李亚普诺夫函数方程v2(Ξ(t))求导:
式中:
其中,H3、H4均为赫尔维兹矩阵,P2为对称正定矩阵,Q3、Q4均为Hermite矩阵;综上,可以证明所设计的内环扩张状态观测器能够在有限时间内稳定到界内。
由此可得,内环有限时间扩张状态观测器在有限时间内稳定。
S603、采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
对于内环有限时间控制器的有限时间稳定性进行证明分为两步:
第一步:为证明内环误差ξ1(t)能在有限时间内收敛到滑模面s(t),设计滑模面设计设计李亚普诺夫函数方程如下:
对李亚普诺夫函数方程v3(s(t))求导:
式中:
且/>为/>收敛后界的绝对值的上界;得到/>综上可得,内环误差ξ1(t)能在有限时间内收敛到滑模面s(t)。
第二步:证明内环误差ξ1(t)能在有限时间内沿着滑模面s(t)收敛到零:
在第一步的基础上,基于得:
根据相关知识,该一阶系统能在有限时间内稳定。即:内环误差ξ1(t)能够在有限时间内沿着滑模面s(t)收敛到零。
由此可得,内环误差ξ1(t)在有限时间内沿着滑模面s(t)收敛到零。
综上,在外环有限时间控制器、内环有限时间扩张状态观测器和内环有限时间控制器的作用下,内外环子系统能够在有限时间内稳定。
本实施例中,S700、对整个双闭环系统进行稳定性分析,具体包括:
可以把该宽频惯性基准单元的误差系统视为如下的串级系统:
式中:
根据,串级系统有限时间稳定性证明的相关知识,在两个子系统都能在有限时间内稳定的前提下,对于任何有界的ξ1(t),设计一个连续且严格递增的函数Bξ(t,e1(t))如下:
/>
式中:
对函数Bξ(t,e1(t))关于时间t求导得:
显然则上式等效于
式中:
ρ1=k1k2+k1+(k4+1)b,ρ2=k1+b+Δ
另外,Ω(Bξ(t,e1(t)))满足Ω(a)≥a,且
由此可得,整个双闭环系统能够在有限时间内稳定。因此,本发明一种考虑移动载体的宽频惯性基准单元有限时间控制方法是有效的。
为验证本发明提出的一种考虑移动载体的宽频惯性基准单元有限时间控制方法的有效性,给出其实验验证,说明考虑移动载体的宽频惯性基准单元有限时间控制方法是有效的,具体如下:
宽频惯性基准单元初始偏转角度为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 (5)
1.一种考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,包括步骤:
将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型;
建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型;
根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值;
根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动;
根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器;
所述将宽频惯性基准单元中移动载体引入的振动视为外部扰动,建立宽频惯性基准单元的二阶数学模型,具体包括:
宽频惯性基准单元的二阶数学模型为:
式中:
2kr2=ka,2cr2=kc,2mcr2+J=ke
式中:x1(t)=θa(t)为宽频惯性基准单元的绝对偏转的角度,为绝对偏转角速度,χ(t)为宽频惯性基准单元的总体扰动,θb(t)为由移动载体引入的宽频惯性基准单元的基座振动角度,/>为由移动载体引入宽频惯性基准单元的基座振动角速度,R为音圈电机等效电阻,La为音圈电机等效电感,kb为音圈电机反感应电动势,kd为音圈电机转矩系数,k为音圈电机刚度,c为音圈电机阻尼系数,mc为音圈电机线圈质量,r为音圈电机分布半径,J为音圈电机运动方向的宽频惯性基准单元转动惯量,u(t)为音圈电机驱动电压,i(t)为音圈电机回路电流;
所述建立宽频惯性基准单元外环数学模型和宽频惯性基准单元内环数学模型,具体包括:
宽频惯性基准单元外环数学模型为:
宽频惯性基准单元内环数学模型为:
式中:uO(t)为外环有限时间控制器;uI(t)为内环有限时间控制器;φ1(t)=x2(t);φ2(t)=χ(t)为扰动的扩张状态,X为一个正常数;
所述根据宽频惯性基准单元外环数学模型,设计外环有限时间控制器,作为宽频惯性基准单元内环数学模型的期望值,具体包括:
外环有限时间控制器为:
式中,k1、k2、k3、k4、α1为正的可调参数,α2=2α1-1,uO(t)为外环有限时间控制器,v(t)为外环期望信号,e1(t)=v(t)-x1(t);e1(t)为外环跟踪误差;
所述根据宽频惯性基准单元内环数学模型,设计内环有限时间扩张状态观测器来估计宽频惯性基准单元的总体扰动,具体包括:
内环有限时间扩张状态观测器为:
式中:
z1(t)为对φ1(t)的估计值;z2(t)为对φ2(t)的估计值,ψ1(t)=z1(t)-φ1(t)为内环有限时间扩张状态观测器对于φ1(t)的估计误差;β1、β2、μ1、α3均为正的可调参数,α4=2α3-1;
所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器,具体包括:
内环有限时间控制器为:
其中滑模面s(t)为:
式中:
G1(ξ1(τ))=|ξ1(τ)|αsign(ξ1(τ))+ξ1(τ)+|ξ1(τ)|βsign(ξ1(τ))
α∈(1-εα,1),β∈(1,1+εβ)
ξ1(t)=uO(t)-x2(t)为内环跟踪误差,l0、l1、εα、εβ、K1为可调正数。
2.根据权利要求1所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述根据宽频惯性基准单元内环数学模型和内环有限时间扩张状态观测器对于扰动的估计值,设计内环有限时间控制器的步骤之后,还包括采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析、采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析和采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析。
3.根据权利要求2所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述采用李亚普诺夫函数对外环有限时间控制器进行收敛性分析,具体包括:
对外环有限时间控制器设计李亚普诺夫函数方程如下:
式中:
对李亚普诺夫函数方程求导:
式中:
其中:H1、H2均为赫尔维兹矩阵,P1为对称正定矩阵,Q1、Q2均为Hermite矩阵;λmin(·)表示矩阵的最小特征值,λmax(·)表示矩阵的最大特征值;||·||表示矩阵的2-范数;
由此可得,外环有限时间控制器在有限时间内稳定。
4.根据权利要求3所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述采用李亚普诺夫函数对内环有限时间扩张状态观测器进行收敛性分析,具体包括:
对内环有限时间扩张状态观测器设计李亚普诺夫函数方程如下:
V2(Ξ(t))=ΞT(t)P2Ξ(t)
式中:
对李亚普诺夫函数方程V2(Ξ(t))求导:
式中:
其中,H3、H4均为赫尔维兹矩阵,P2为对称正定矩阵,Q3、Q4均为Hermite矩阵;
由此可得,内环有限时间扩张状态观测器在有限时间内稳定。
5.根据权利要求2所述的考虑移动载体的宽频惯性基准单元有限时间控制方法,其特征在于,所述采用李亚普诺夫函数对内环有限时间控制器进行收敛性分析,具体包括:
为证明内环误差ξ1(t)能在有限时间内收敛到滑模面s(t),设计滑模面设计设计李亚普诺夫函数方程如下:
对李亚普诺夫函数方程V3(s(t))求导:
式中:
且/>为ψ2(t)收敛后界的绝对值的上界;得到/>
由此可得,内环误差ξ1(t)在有限时间内收敛到滑模面s(t);
证明内环误差ξ1(t)能在有限时间内沿着滑模面s(t)收敛到零:
基于得:
由此可得,内环误差ξ1(t)在有限时间内沿着滑模面s(t)收敛到零。
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 CN115933411A (zh) | 2023-04-07 |
CN115933411B true 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)
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 | 哈尔滨工程大学 | 基于有限时间扰动观测器的机器鱼精确地形跟踪控制方法 |
-
2023
- 2023-01-13 CN CN202310041278.2A patent/CN115933411B/zh active Active
Patent Citations (6)
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 |
---|---|
CN115933411A (zh) | 2023-04-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109927032B (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
CN110716506B (zh) | 一种基于混合滑模控制的伺服系统位置跟踪控制方法 | |
Labbadi et al. | Novel robust super twisting integral sliding mode controller for a quadrotor under external disturbances | |
CN107831655B (zh) | 微陀螺仪的分数阶自适应反演模糊滑模控制方法 | |
Fei | Robust adaptive vibration tracking control for a micro-electro-mechanical systems vibratory gyroscope with bound estimation | |
CN114326399B (zh) | 一种宽频惯性基准单元有限时间抗干扰控制方法 | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
CN110941184A (zh) | 一种电磁轴承柔性转子不同位系统滑模振动主动控制方法 | |
CN106915476B (zh) | 一种分离式电磁力耦合卫星载荷指向操控方法 | |
CN111258216A (zh) | 一种适用于四旋翼飞行器的滑模重复控制器 | |
CN112769364B (zh) | 一种直流电机伺服系统的快速自适应抗扰控制方法 | |
CN113467245A (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 | |
Li et al. | Speed tracking control for the gimbal system with harmonic drive | |
Jia et al. | Vibration control of gyroelastic spacecraft using input shaping and angular momentum devices | |
Shi et al. | Active vibration isolation of a maglev inertially stabilized platform based on an improved linear extended state observer | |
KR20140094313A (ko) | 마찰력 보상기 및 이를 이용한 마찰력 보상방법 | |
Xinli et al. | A finite-time robust adaptive sliding mode control for electro-optical targeting system with friction compensation | |
CN115933411B (zh) | 一种考虑移动载体的宽频惯性基准单元有限时间控制方法 | |
Su et al. | The precise control of a double gimbal MSCMG based on modal separation and feedback linearization | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN107870566A (zh) | 基于平行估计复合学习的mems陀螺仪快速启动方法 | |
Ben Tarla et al. | Robustifying hierarchical sliding mode control for active vibration suppression of a flexible manipulator using integral sliding mode control | |
Lu et al. | Compound optimal control of harmonic drive considering hysteresis characteristic |
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 |