CN108536185B - 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 - Google Patents
一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 Download PDFInfo
- Publication number
- CN108536185B CN108536185B CN201810434916.6A CN201810434916A CN108536185B CN 108536185 B CN108536185 B CN 108536185B CN 201810434916 A CN201810434916 A CN 201810434916A CN 108536185 B CN108536185 B CN 108536185B
- Authority
- CN
- China
- Prior art keywords
- rceso
- frame
- state
- interference
- equation
- 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 29
- 239000000725 suspension Substances 0.000 title claims abstract description 18
- 238000005457 optimization Methods 0.000 title claims abstract description 13
- 230000009466 transformation Effects 0.000 claims abstract description 5
- 238000010168 coupling process Methods 0.000 claims description 8
- 238000005859 coupling reaction Methods 0.000 claims description 8
- 238000013178 mathematical model Methods 0.000 abstract description 3
- 230000008878 coupling Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- 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
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出了一种基于降阶级联扩张状态观测器的双框架磁悬浮CMG框架***参数优化方法。首先建立双框架伺服***动力学模型,并通过坐标变换转换为满足构建降阶级联扩张状态观测器(RCESO)积分链形式的***状态方程,将此***状态方程代入RCESO状态模型中,得到***干扰到干扰估计的传递函数,基于上述传递函数分析RCESO参数同频域特性的关系,进而设计满足***指标的参数配置方法。本发明简化了传统的级联扩张状态观测器(CESO)数学模型并提高了其干扰估计性能,适用于级联形式的扩张状态观测器参数配置。
Description
技术领域
本发明属于基于观测器的双框架磁悬浮控制CMG框架***参数优化领域,具体涉及一种采用基于降阶级联扩张状态观测器的双框架磁悬浮CMG框架***参数优化方法,用于提高框架***的干扰抑制能力,实现框架伺服***的高精度角速率跟踪控制,进而实现控制力矩陀螺高精度力矩输出。
背景技术
控制力矩陀螺(CMG)具有输出力矩大,动态性能好,控制精度高的优点,是大型航天器姿态控制的首选执行器。根据框架的自由度可分为单框架CMG和双框架CMG。按照高速转子的支撑方式可分为机械轴承CMG和磁悬浮CMG。双框架磁悬浮CMG具有扭矩输出大,精度高,输出扭矩有两个自由度的优点,对空间站和卫星姿态控制***非常有吸引力。双框架磁悬浮CMG主要由磁悬浮高速转子***和内外框架***组成,其工作原理是:根据陀螺效应,内外框架旋转强制改变转子角动量方向从而输出陀螺力矩。框架***的角速度精度决定了双框架磁悬浮CMG输出转矩的精度,因此提高框架伺服控制***的角速度精度具有重要意义。
由于强大的陀螺效应,内外框架之间会产生明显的耦合力矩。耦合力矩是非线性的,并与外部框架的角位置和速度有关,这是影响框架***角速度的主要因素之一。另外,框架伺服***是一个非常低速的机械伺服***,由于陀螺耦合力矩,摩擦力矩是非线性的,因此构建精确的***模型是非常困难的,所以摩擦力矩是影响框架伺服性能的另一个主要因素。要实现框架***高精度速率控制,必须克服耦合力矩和非线性摩擦力矩等未知不匹配干扰对框架***伺服性能的影响。
为解决上述不匹配干扰导致框架***角速率精度降低的问题,基于模态分离方法的简化反馈线性化控制方法可以解耦双框架磁悬浮CMG***,但是需要一个精确的数学模型;微分几何解耦方法可以解耦双框架磁悬浮CMG***,但是不能完全消除耦合力矩的影响;扩张状态观测器(ESO)作为一种有效的干扰估计技术,将集总干扰扩张为***的新状态,然而如果***状态方程的阶数大于2,则很难在实际应用中配置满足***精度要求的ESO参数;级联ESO(CESO)将ESO的参数调整简化为两个参数的调整,但是CESO的两个参数是按照二阶ESO参数配置方法进行配置,没有针对CESO进行参数配置的方法。
发明内容
本发明要解决的技术问题是:克服现有方法的不足,提供了一种基于降阶级联扩张状态观测器的双框架磁悬浮CMG框架***参数优化方法,该方法不仅提高了框架伺服***的角速率跟踪性能,还增强了框架***对不匹配干扰的鲁棒性。
本发明解决上述技术问题采用的技术方案为:一种基于降阶级联扩张状态观测器的双框架磁悬浮CMG框架***参数优化方法,包括以下步骤:
步骤(1):根据双框架伺服***动力学模型建立状态空间方程
内外框架***的动力学方程和转矩平衡方程可写为:
其中,θx和θy分别是内外框架的角位置,Tx和Ty分别是内外框架的输出转矩,Kx和Ky分别是扭矩系数,Jx和Jy是内外框架的等效转动惯量,Fx和Fy是内外框架的未建模动态,fx和fy是非线性摩擦转矩,Tx和Ty是框架电机的输出转矩,Hz是高速转子的角动量,ux和uy是框架电机的控制电压,Ix和Iy是力矩电机的电流,Rx和Ry是力矩电机的定子电阻,Lx和Ly是电感,Cex和Cey是反电动势系数。
控制输入ux和扰动d1不在同一个通道中,通过引入CESO来估计总干扰并在控制器中补偿其影响,但此状态空间方程不符合CESO积分链形式,因此引入坐标变换转换为积分链形式;
步骤(2):根据所述步骤(1)中的内框架***的积分链形式的状态空间方程,通过将角速度作为CESO的参考输入,可以将三个相似的二阶扩张状态观测器(ESO)级联的传统CESO转化为两个相似的二阶ESO级联的RCESO,从而简化了传统CESO的模型。RCESO对集总干扰进行估计,并结合状态反馈控制器对集总干扰的影响进行补偿,最终消除不匹配干扰。
步骤(3):根据所述步骤(1)和(2)中的积分链形式的***状态方程和RCESO状态方程,将二者结合,可得从集总干扰到其估计值的传递函数。并通过推导RCESO参数与传递函数频率特性的数学关系,得到满足***指标要求的RCESO参数配置方法。
进一步的,根据积分链形式的***状态方程和RCESO模型获得参数配置方法如下:
积分链形式的内框架状态空间方程为:
y=[0 1 0]v
构建RCESO模型为:
其中,为RCESO的状态变量,用于估计v2,用于估计v3,用于估计f。为估计误差,定义为 和是RCESO的参数。在框架***中,扰动f是有界的,其上限频率为ω0,且其导数也有界,RCESO的稳态误差可以通过调整和而被限制在非常小的值。
结合RCESO的状态方程和框架***的状态空间方程,上式可化为:
干扰传递函数的幅频特性和相频特性为:
为了使RCESO在给定的频率带宽ω∈[0,ω0]内具有良好的观测能力,给出了以下频域性能指标:
为了满足幅频误差和相频误差的要求,并结合RCESO的稳定条件可以得出A(ω)在ω∈[0,ω0]内单调递减,滞后相角随着ω增加而增加,幅频误差和相位频率误差同时在ω=ω0时达到频域指标中的最大值。一旦A(ω0)和满足频域性能指标,A(ω)和在ω∈(0,ω0)内当然满足。
建立如下方程:
本发明的基本原理是:本发明根据框架伺服控制***动力学模型建立积分链形式的状态方程,并构建降阶的级联扩张状态观测器模型,简化传统的级联扩张状态观测器的模型。将积分链形式的***状态方程与RCESO模型结合,可得从集总干扰到其估计值的传递函数。并通过推导RCESO参数与传递函数频率特性的数学关系,得到满足***指标要求的RCESO参数配置方法。经过参数优化的RCESO对集总干扰估计更加精确,并结合状态反馈控制器对集总干扰的影响进行补偿,从而对***扰动进行了抑制,实现高精度框架角速率输出。
本发明与现有技术相比的优点在于:
1、由三个具有同一参数的二阶ESO进行级联降低为两个具有同一参数的二阶ESO进行级联,简化了CESO的模型。可以很好的解决由于***阶数高引起的传统CESO阶数高、数学模型复杂的问题。
2、通过对RCESO的两个参数和进行优化设计,克服传统CESO参数按照二阶ESO参数配置方法进行配置带来的干扰估计性能不佳的问题,提高了RCESO的干扰估计性能。并通过在复合控制器中补偿干扰估计项,提高了***整体的抗干扰能力,***输出角速率精度有所提高。
附图说明
图1为框架角速率伺服***控制算法流程图;
图2为传统的CESO示意图;
图3为传统的CESO结构图;
图4为本发明的RCESO示意图;
图5为本发明的RCESO结构图;
图6为基于RCESO的框架角速率伺服***整体控制算法结构图。
具体实施方式
下面结合附图以及具体实施方式进一步说明本发明。
如图1所示,一种基于降阶级联扩张状态观测器的双框架磁悬浮CMG框架***参数优化方法,首先对框架伺服控制***进行动力学建模,根据动力学模型建立积分链形式的状态方程;根据积分链形式的***状态方程和RCESO状态方程,将二者结合,可得从集总干扰到其估计值的传递函数。并通过推导RCESO参数与传递函数频率特性的数学关系,得到满足***指标要求的RCESO参数配置方法。RCESO对集总干扰进行估计,并结合状态反馈控制器对集总干扰的影响进行补偿,从而对***扰动进行了抑制,实现高精度框架角速率输出。
本发明的具体实施方式如下:
(1)根据双框架伺服***动力学模型建立积分链形式的状态空间方程
内外框架***的动力学方程和转矩平衡方程可写为:
其中,θx和θy分别是内外框架的角位置,Tx和Ty分别是内外框架的输出转矩,Kx和Ky分别是扭矩系数,Jx和Jy是内外框架的等效转动惯量,Fx和Fy是内外框架的未建模动态,fx和fy是非线性摩擦转矩,Tx和Ty是框架电机的输出转矩,Hz是高速转子的角动量,ux和uy是框架电机的控制电压,Ix和Iy是力矩电机的电流,Rx和Ry是力矩电机的定子电阻,Lx和Ly是电感,Cex和Cey是反电动势系数。
从(2)中可以看出,控制输入ux和扰动d1不在同一个通道中,从而导致了不匹配的问题。通过引入CESO来估计总干扰并在控制器中补偿它的影响,可以解决不匹配的问题。但是,(2)不符合传统的CESO积分链形式,因此需要引入坐标变换。新坐标被定义为v=[v1,v2,v3]Τ,其中,v1=x1,v2=x2,积分链形式的内框架状态空间方程为:
(2)构建RCESO模型
对于一个三阶***,如果我们将角位置v1作为CESO的参考输入,那么线性CESO将由三个具有相同参数的相似二阶ESO级联,CESO的结构如图2所示。CESO的状态变量定义为z=[z1,z2,z3,z4,z5,z6]Τ,其中z1用于估计v1,z2用于估计v2,z4用于估计v3,z6用于估计f,并且z3和z5是中间变量。估计误差定义为e1=z1-v1,e2=z2-v2,e3=z3-z2,e4=z4-v3,e5=z5-z4,e6=z6-f。β1和β2是CESO的两个参数。如图3所示,CESO的状态方程描述如下:
由于框架***的控制目标是实现精确的角速度跟踪控制,因此我们可以将角速度v2作为CESO设计中的参考输入。这表明我们可以构造一个降阶的CESO,只需要估计v2,v3和f。因此,传统的CESO可以转化为由两个相似的二阶ESO级联的RCESO,这简化了传统CESO的模型。RCESO的结构如图4所示。
RCESO的稳态误差为:
(3)获得干扰传递函数
将RCESO状态方程拉氏变换得:
结合RCESO的状态方程和框架***的状态空间方程,上式可化为:
(4)RCESO参数配置方法设计
干扰传递函数的幅频特性和相频特性为:
为了使RCESO在给定的频率带宽ω∈[0,ω0]内具有良好的观测能力,给出了以下频域性能指标:
为了满足公式(14)给出的幅频误差和相频误差的要求,并结合RCESO的稳定条件可以得出A(ω)在ω∈[0,ω0]内单调递减。此外,从(13)可以看出,滞后相角随着ω增加而增加。因此,幅频误差和相位频率误差同时在ω=ω0时达到频域指标(14)中的最大值。一旦A(ω0)和满足频域性能指标(14),A(ω)和在ω∈(0,ω0)内当然满足。
建立如下方程:
②当b1<1时,
在以上两个式子中,降阶级联扩张状态观测器的稳定条件可以表示为其中因此,对于任意的ω0>0,0<A0<1,如果RCESO的参数满足条件(17)和(18)中的任何一个情况,那么RCESO对总干扰f的估计满足频域性能指标(14)。
控制律为:
其中,rv为角速率指令,rp为经角速率指令积分后得到的参考转子位置信息,v1为框架角位置,v2为框架角速率,为级联扩张状态观测器产生的附加控制量;k1、k2、k3为控制器的3个设计参数,bx为框架***参数,ux为控制器控制输出。
以上经过参数优化的RCESO对集总干扰进行估计,结合上式状态反馈控制器对集总干扰的影响进行补偿,从而对***扰动进行抑制,实现高精度框架角速率输出。框架角速率伺服***整体控制算法关系图如图6所示。
(5)具体参数配置
整个控制算法需要配置的参数有5个,即:控制器参数k1、k2、k3以及级联扩张状态观测器两个参数其中,控制器参数k1、k2、k3按照极点配置方式进行配置,RCESO的两个参数按照上述方法配置。通过采用上述控制算法,可以提高框架***的速率伺服精度。
以角动量为20Nms的磁悬浮控制力矩陀螺框架角速率伺服***为例,角速率带宽为5Hz。***参数如表1所示。
表1***参数
控制器参数k1、k2、k3按照极点配置方式配置为:
k1=1.1×106,k2=1.2×105,k3=1.1×103。
经仿真验证,在角速率指令为5°/s时,本发明中的***输出角速率速率波动仅为0.013°/s,和一种双框架磁悬浮CMG框架***的高精度摩擦补偿控制方法(专利号:ZL201510561163.1)相比,本发明中的***输出角速率精度提升了9.1%。
Claims (1)
1.一种基于降阶级联扩张状态观测器的双框架磁悬浮CMG框架***参数优化方法,其特征在于,包括以下步骤:
步骤(1):根据双框架伺服***动力学模型建立状态空间方程
内外框架***的动力学方程和转矩平衡方程可写为:
其中,θx和θy分别是内外框架的角位置,Tx和Ty分别是内外框架的输出转矩,Kx和Ky分别是扭矩系数,Jx和Jy是内外框架的等效转动惯量,Fx和Fy是内外框架的未建模动态,fx和fy是非线性摩擦转矩,Tx和Ty是框架电机的输出转矩,Hz是高速转子的角动量,ux和uy是框架电机的控制电压,Ix和Iy是力矩电机的电流,Rx和Ry是力矩电机的定子电阻,Lx和Ly是电感,Cex和Cey是反电动势系数;
控制输入ux和扰动d1不在同一个通道中,通过引入CESO来估计总干扰并在控制器中补偿其影响,但此状态空间方程不符合CESO积分链形式,因此引入坐标变换转换为积分链形式;
步骤(2):根据所述步骤(1)中的内框架***的积分链形式的状态空间方程,通过将角速度作为CESO的参考输入,可以将三个相似的二阶扩张状态观测器(ESO)级联的传统CESO转化为两个相似的二阶ESO级联的RCESO,从而简化了传统CESO的模型;
步骤(3):根据所述步骤(1)和(2)中的积分链形式的***状态方程和RCESO状态方程,将二者结合,可得从集总干扰到其估计值的传递函数;并通过推导RCESO参数与传递函数频率特性的数学关系,得到满足***指标要求的RCESO参数配置方法;RCESO对集总干扰进行估计,并结合状态反馈控制器对集总干扰的影响进行补偿,最终消除不匹配干扰;
根据积分链形式的***状态方程和RCESO模型获得参数配置方法如下:
积分链形式的内框架状态空间方程为:
y=[0 1 0]v
构建RCESO模型为:
其中,为RCESO的状态变量,用于估计v2,用于估计v3,用于估计f,为估计误差,定义为 和是RCESO的参数;在框架***中,扰动f是有界的,其上限频率为ω0,且其导数也有界,RCESO的稳态误差可以通过调整和而被限制在非常小的值;
结合RCESO的状态方程和框架***的状态空间方程,上式可化为:
干扰传递函数的幅频特性和相频特性为:
为了使RCESO在给定的频率带宽ω∈[0,ω0]内具有良好的观测能力,给出了以下频域性能指标:
为了满足幅频误差和相频误差的要求,并结合RCESO的稳定条件可以得出A(ω)在ω∈[0,ω0]内单调递减,滞后相角随着ω增加而增加,幅频误差和相位频率误差同时在ω=ω0时达到频域指标中的最大值;一旦A(ω0)和满足频域性能指标,A(ω)和在ω∈(0,ω0)内当然满足;
建立如下方程:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810434916.6A CN108536185B (zh) | 2018-05-09 | 2018-05-09 | 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810434916.6A CN108536185B (zh) | 2018-05-09 | 2018-05-09 | 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108536185A CN108536185A (zh) | 2018-09-14 |
CN108536185B true CN108536185B (zh) | 2020-09-08 |
Family
ID=63477053
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810434916.6A Active CN108536185B (zh) | 2018-05-09 | 2018-05-09 | 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108536185B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110412867B (zh) * | 2019-05-17 | 2020-08-11 | 北京航空航天大学 | 一种磁悬浮控制力矩陀螺框架***高精度角速率控制方法 |
CN112256048B (zh) * | 2020-10-13 | 2022-02-11 | 北京航空航天大学 | 一种混合灵敏度优化的cmg框架***速度调节方法 |
CN112631318B (zh) * | 2020-12-08 | 2021-12-10 | 北京航空航天大学 | 一种cmg框架伺服***高次谐波干扰补偿控制方法 |
CN113341714B (zh) * | 2021-06-02 | 2022-05-27 | 南京工业大学 | 一种磁悬浮轴承转子控制***同频干扰的抵消方法 |
CN114415521B (zh) * | 2022-03-25 | 2022-07-05 | 北京航空航天大学 | 一种谐波减速器驱动的框架***抗干扰控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107992110B (zh) * | 2018-01-18 | 2020-09-08 | 北京航空航天大学 | 一种基于谐波减速器的磁悬浮控制力矩陀螺框架角速率伺服*** |
-
2018
- 2018-05-09 CN CN201810434916.6A patent/CN108536185B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108536185A (zh) | 2018-09-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108536185B (zh) | 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 | |
CN108762096B (zh) | 一种基于离散型非线性级联扩张状态观测器的控制力矩陀螺框架***扰动抑制方法 | |
CN110429881B (zh) | 一种永磁同步电机的自抗扰控制方法 | |
CN110716506B (zh) | 一种基于混合滑模控制的伺服***位置跟踪控制方法 | |
CN104242769A (zh) | 基于连续终端滑模技术的永磁同步电机速度复合控制方法 | |
CN104865968A (zh) | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 | |
CN109062043B (zh) | 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 | |
CN110247585B (zh) | 一种基于滑模变结构的多轴伺服变比例协同控制方法 | |
CN111830828B (zh) | 一种fopd-geso控制器的设计方法 | |
CN107168072B (zh) | 一种基于干扰观测器的非匹配干扰***自抗扰控制方法 | |
CN111638641B (zh) | 一种调控电机速度环的分数阶自抗扰控制器的设计方法 | |
CN112769364B (zh) | 一种直流电机伺服***的快速自适应抗扰控制方法 | |
CN113241973A (zh) | S型滤波器迭代学习控制直线电机轨迹跟踪控制方法 | |
CN113572402A (zh) | 圆筒型永磁直线同步电机复合滑模速度控制方法及*** | |
CN114706300B (zh) | 具有扰动及输出约束的永磁同步电机***有限时间控制法 | |
CN114280944B (zh) | 一种具有输出约束的pmsm***有限时间动态面控制方法 | |
CN115202213A (zh) | 一种基于自抗扰控制的四旋翼飞行器控制方法 | |
CN112187127A (zh) | 一种永磁同步电机控制方法 | |
CN115268369A (zh) | 一种龙门机床动梁交叉耦合控制方法 | |
CN112783099B (zh) | 分数阶复合控制方法和永磁同步电动机速度伺服*** | |
Ma et al. | Chattering‐Free Sliding‐Mode Control for Electromechanical Actuator with Backlash Nonlinearity | |
CN110888320B (zh) | 基于双电动缸同步运动误差建模的自适应鲁棒控制方法 | |
CN116442223A (zh) | 一种机械手***轨迹跟踪的非线性动态控制器设计方法 | |
CN115133825A (zh) | 一种基于滑模扩张状态观测器的永磁同步电机互补滑模位置控制方法 | |
CN112821840B (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 |