一种抑制转子动不平衡扰动的控制力矩陀螺框架控制系统及方法

摘要

一种抑制转子动不平衡扰动的控制力矩陀螺框架控制系统及方法，系统在双环PI控制系统基础上嵌入前馈补偿模块和算法切换模块；在预设的Ng个控制周期内，设置整个框架控制系统工作在PI控制模式；从Ng+1控制周期开始，在每个控制周期，通过算法切换模块计算当前控制周期内CMG框架转速精度，确定是否需要切换当前控制周期的控制模式，若切换后为前馈补偿模式，则将速度环PI控制器输出的力矩参考值与反馈的框架电机的转矩做差，得到当前控制周期的机械转矩误差ej+1，前馈补偿模块根据ej+1计算当前控制周期的电流前馈补偿值Δiqref,j+1，将Δiqref,j+1加入所述的双环PI控制系统；若切换后为PI控制模式，则封锁电流前馈补偿，按照双环PI控制系统进行控制。

说明书

技术领域

本发明涉及一种满足航天应用要求的控制力矩陀螺高精度框架控制方法， 在航天应用条件下，可满足高精度框架控制要求。

背景技术

航天领域中，控制力矩陀螺中框架组件的转速控制精度对整机的工作性能 有直接影响，对卫星的姿态稳定性与姿态控制精度起着重要作用。

单框架控制力矩陀螺低速框架的驱动一般使用永磁同步电机。在结合了矢 量控制后，永磁同步电机具有在低速转动状态下输出力矩精度高，控制性能好 的特点。为了提高永磁同步电机的输出力矩精度，即抑制电机的输出力矩波动， DaningZhou提出了双环PI控制器的方法：

DaningZhou,“TheDesign,GroundTestandFlightValidationofaHigh AccuracyServoSchemeforControlMomentGyroscopeApplication,”19^thIFACSymposiumonAutomaticControlinAerospace,2013.09，pp.466～471

该方法得到了在轨验证，取得了良好的控制效果。

随着卫星成像分辨率的进一步提高，如何进一步提高控制力矩陀螺输出力 矩的精度，即抑制框架转速波动，成为了控制力矩陀螺输控制技术需要解决的 一个棘手问题。经过理论分析由于高速转子的动不平衡产生的一个周期性变化 的扰动力矩会直接作用在框架上，是控制力矩陀螺输低速框架转速波动的一个 重要来源。为实现对输出力矩的高精度控制，就必须消除动不平衡产生的扰动 力矩。双环PI控制器，在抑制这种频率较高且幅值较大的扰动上，不能够达到 理想的效果。

发明内容

本发明的技术解决问题是：克服现有技术的不足，提供一种抑制转子动不 平衡扰动的控制力矩陀螺框架控制系统及方法。

本发明的技术解决方案是：一种抑制转子动不平衡扰动的控制力矩陀螺框 架控制系统，包括双环PI控制系统，所述的双环PI控制系统包括速度环PI控 制器、电流环PI控制器、框架电机和CMG框架；前馈补偿模块和算法切换模 块；

在预设的N_g个控制周期内，设置整个框架控制系统工作在PI控制模式， 即按照双环PI控制系统进行控制；

从N_g+1控制周期开始，通过算法切换模块计算当前控制周期内CMG框架 转速精度，根据算法切换逻辑结合框架转速精度，确定是否需要切换当前控制 周期的控制模式，若切换后当前控制周期为前馈补偿模式，则在当前控制周期 T_j+1，将速度环PI控制器输出的力矩参考值与反馈的框架电机的机械转矩做差， 得到当前控制周期的机械转矩误差e_j+1将该机械转矩误差e_j+1输入前馈补偿模 块，由前馈补偿模块计算当前控制周期的电流前馈补偿值Δi_qref,j+1，通过算法切 换模块将Δi_qref,j+1加入所述的双环PI控制系统；；

若切换后当前控制周期为PI控制模式，则封锁电流前馈补偿，按照双环 PI控制系统进行控制。

当前控制周期的电流前馈补偿值Δi_qref,j+1计算公式如下：

${\mathrm{\Delta i}}_{qref,j+1}=K_2{e}_{j+1}+K_1{e}_{j+1-N_f}+(1-\alpha ){\mathrm{\Delta i}}_{qref,j+1-N_f}$

其中，N_f为补偿周期所对应的控制周期数；所述的补偿周期为框架电机高 速转子的转动周期；

e_j+1-Nf为上一补偿周期的机械转矩误差；

Δi_qref,j+1-Nf为上一补偿周期的电流前馈补偿值，电流前馈补偿初值为 0；

α为遗忘因子，α∈[0,1]；

K₁、K₂为补偿系数，补偿系数取值满足：

$0<K_1<\frac{2-\alpha }{k_t}$

0<K₂≤K₁。

所述的CMG框架转速精度的计算公式如下：

$v_G=\frac{|{\bar{\theta }}_m-{\theta }_g|}{{\theta }_g}$

其中，θ_g：角度增量名义值，即根据外部的转速指令计算出的框架指令转 角值；

实测平均值，

为实测的第k次CMG框架的转角值。

所述的算法切换逻辑如下：

(4.1)判断当前控制模式，若当前控制周期工作在PI控制模式下，则进 入步骤(4.2)；若工作在前馈补偿模式，则进入步骤(4.3)；

(4.2)判断当前控制周期的CMG框架转速精度V_G是否大于ε，若V_G> ε，则计数值Count清零，当前控制周期控制模式保持不变，当前控制周期判 断结束；否则计数值Count+1，并进一步判断Count是否大于预设的门限次数 N，若Count>N，则计数值Count清零，并将当前控制周期的控制模式切换为 前馈补偿模式；若Count≤N，则当前控制周期控制模式保持不变，当前控制 周期判断结束；

(4.3)判断当前控制周期的CMG框架转速精度V_G是否小于等于ε，若 V_G≤ε，则计数值Count清零，当前控制周期控制模式保持不变，当前控制周 期判断结束；否则计数值Count+1，并进一步判断Count是否大于预设的门限 次数N，若Count>N，则计数值Count清零，并将当前控制周期的控制模式切 换为PI控制模式；若Count≤N，则当前控制周期控制模式保持不变，当前控 制周期判断结束；

上述，ε为转速精度规范值，Count初值为0。

一种抑制转子动不平衡扰动的控制力矩陀螺框架控制方法，包括PI控制模 式和前馈控制模式两种控制模式；

(1)从起始控制到预设的N_g个控制周期内，按照PI控制模式对CMG框 架进行控制；

(2)进入第N_g+1个控制周期，设置计数值Count初值为0；

(3)在当前控制周期T_j+1，将转速给定值ω_ref与采集的框架电机的转速值 ω_m做差，根据该差值得到力矩参考值T_ref，将该转矩参考值T_ref除以电机等效 力矩系数k_t，得到q轴电流的初始给定值i_qref0；j初始值为N_g；

(4)计算CMG框架在当前控制周期的转速精度V_G，按照下述逻辑进行 判断：

(4.1)判断当前控制模式，若当前控制周期工作在PI控制模式下，则进 入步骤(4.2)；若工作在前馈补偿模式，则进入步骤(4.3)；

(4.2)判断当前控制周期的CMG框架转速精度V_G是否大于ε，若V_G> ε，则计数值Count清零，当前控制周期控制模式保持不变，当前控制周期判 断结束；否则计数值Count+1，并进一步判断Count是否大于预设的门限次数 N，若Count>N，则计数值Count清零，并将当前控制周期的控制模式切换为 前馈补偿模式；若Count≤N，则当前控制周期控制模式保持不变，当前控制 周期判断结束；

(4.3)判断当前控制周期的CMG框架转速精度V_G是否小于等于ε，若 V_G≤ε，则计数值Count清零，当前控制周期控制模式保持不变，当前控制周 期判断结束；否则计数值Count+1，并进一步判断Count是否大于预设的门限 次数N，若Count>N，则计数值Count清零，并将当前控制周期的控制模式切 换为PI控制模式；若Count≤N，则当前控制周期控制模式保持不变，当前控 制周期判断结束；

上述，ε为转速精度规范值；

(5)根据步骤(4)的结果，若切换后当前控制周期为前馈补偿模式，则 执行步骤(6)、步骤(7)，利用步骤(7)中得到的当前控制周期的电流前馈 补偿值Δi_qref,j+1对步骤(3)中得到的q轴电流的初始给定值i_qref0进行补偿，并 利用补偿后的电流值通过框架电机对CMG框架进行控制，进入下一控制周期， 令j的取值加1，转步骤(3)；若切换后当前控制周期为PI控制模式，则封锁 步骤(6)、步骤(7)，直接利用步骤(3)中得到的q轴电流的初始给定值i_qref0通过框架电机对CMG框架进行控制，进入下一控制周期，令j的取值加1，转 步骤(3)；

(6)根据当前控制周期框架转速的角加速度和框架的转动惯量，得到作用 在CMG框架上的机械转矩T_m；将步骤(3)中的力矩参考值T_ref与T_m做差， 得到当前控制周期的机械转矩误差e_j+1；

(7)根据机械转矩误差e_j+1计算当前控制周期的电流前馈补偿值Δi_qref,j+1。

当前控制周期的电流前馈补偿值Δi_qref,j+1计算公式如下：

${\mathrm{\Delta i}}_{qref,j+1}=K_2{e}_{j+1}+K_1{e}_{j+1-N_f}+(1-\alpha ){\mathrm{\Delta i}}_{qref,j+1-N_f}$

其中，N_f为补偿周期所对应的控制周期数，所述的补偿周期为高速转子的 转动周期；

e_j+1-Nf为上一补偿周期的机械转矩误差；

Δi_qref,j+1-Nf为上一补偿周期的电流前馈补偿值，电流前馈补偿初值为 0；

K₁、K₂为补偿系数，补偿系数取值满足：

$0<K_1<\frac{2-\alpha }{k_t}$

0<K₂≤K₁。

所述的CMG框架转速精度的计算公式如下：

$v_G=\frac{|{\bar{\theta }}_m-{\theta }_g|}{{\theta }_g}$

其中，θ_g：角度增量名义值，即根据外部的转速指令计算出的框架指令转 角值；

实测平均值，

为实测的第k次CMG框架的转角值。

本发明与现有技术相比有益效果为：

本方法针对航天器用控制力矩陀螺转子动不平衡力矩对框架控制精度的影 响，首次将前馈补偿算法应用于控制力矩陀螺低速框架的控制中，并设计了算 法切换逻辑，既大幅降低了由转子动不平衡引起的扰振力矩，又保证了框架动 态性能。

通过实验验证，采用SRF的定义，即SRF＝S_pp/S_ave(转速波动量峰-峰值 与转速平均值之比)来说明这种抑制转子动不平衡扰动的控制方法的控制效果。 对同一被控对象采用传统双环PI控制器SRF＝40％，而加入了前馈控制模块， SRF＝14％。对于CMG而言，大幅度降低框架的转速波动，可以大大提高输出 力矩的精度，从而进一步提高整星的机动性能以及搭载的光学成像设备的成像 效果。

与现有技术方案相比，该控制方法具有如下优点：

(1)传统的双环PI控制器，在抑制由转子动不平衡产生的，频率较高且幅值 较大的扰动上，不能够达到理想的效果。本发明提出的一种控制力矩陀螺 框架控制方法，将前馈补偿策略引入到双环PI控制系统中，并设计了相 应的算法切换逻辑，在不改变原有控制系统架构的情况下，通过内嵌前馈 补偿模块，达到抑制周期性波动的转子动不平衡力矩的目的。与现有PI 双环控制方法相比，该方法将控制力矩陀螺框架转速波动量降低了60％ 以上，从而提高了其输出力矩精度。

(2)本方法中，转矩反馈量为作用在框架电机轴上的机械转矩，包括了电机输 出的电磁转矩、阻力矩和由转子动不平衡产生的扰动力矩。通过闭环控制， 使电机输出相应的补偿力矩以抵消阻力矩和扰动力矩的影响，实现框架转 速高精度控制。这与传统方法为了消除电机输出电磁转矩波动的目的和效 果是完全不同的，因此本方法也避免了采用力矩观测器来估计电磁转矩， 降低了算法的复杂程度。

(3)本方法不需要进行微分方程求解，计算量小，可以满足控制力矩陀螺控制 系统实时性的要求。具有较强的实用性。

该方法可以应用于各类型高精度控制力矩陀螺产品，以大幅度降低由转子 动不平衡引起的框架扰动，提高输出力矩精度，使各类型遥感卫星实现高精度 成像，极大的提升卫星的数据获取能力和成像分辨率。

附图说明

图1为本发明系统框图；

图2为前馈补偿模块补偿示意图。

具体实施方式

如在对控制力矩陀螺输(CMG)进行振动测试时，发现实际作用在低速框 架上的转子动不平衡扰动力矩频率的基频为高速转子转速频率，还有其相应的 倍频分量，包括3，5，7倍频。由于CMG转子转速为恒定值，因此转子动不 平衡扰动力矩的频率为恒定值，即为一组周期性运动的扰动力矩。为了抑制这 一系列扰动力矩，从而抑制CMG框架转速波动量，在传统的双环PI控制系统 中，加入了前馈补偿模块和算法切换模块，如图1所示。

前馈补偿的主要思想是，针对在有限区间上周期性运动的动态系统，利用 上一周期迭代的误差量来修正当前的控制给定，直至系统的输出能够完全跟踪 期望轨迹。将前馈补偿模块引入到双环PI控制系统中，在不改变原有控制系统 架构的情况下，通过内嵌前馈模块，可以达到抑制周期性波动的转子动不平衡 力矩的目的。

由于这种前馈控制在被控框架转速稳定时，才能根据周期性运动规律产生 补偿值修正控制给定，所以对于CMG在框架转速指令发生变化的暂态过程， 为保证系统的响应带宽，控制系统将切换到双环PI控制模式，当框架转速达到 稳定后，前馈补偿输出接入控制系统，以提高CMG力矩输出的稳定性。具体 介绍如下：

本发明是建立在双环PI控制模式基础上的，如图1所示。框架电机3驱动 框架4旋转，在框架电机输出轴上作用有驱动电机的电磁转矩T_e，阻力矩T_f， 和由转子动不平衡产生的扰动力矩T_imbalance。

1)转角与电流采集与变换

通过旋转变压器测量框架电机3的转角θ_m。

通过电流采样电路测得框架电机的电流i_A，i_B，i_C，并通过坐标变换计算得 出两相静止坐标系下的α，β轴电流i_α和i_β，

计算公式如下：

$\left(\begin{array}{c}{i}_{\alpha }\\ i_{\beta }\end{array}\right)=\frac{2}{3}·\left(\begin{array}{ccc}1& -\frac{1}{2}& -\frac{1}{2}\\ 0& \frac{\sqrt{3}}{2}& -\frac{\sqrt{3}}{2}\end{array}\right).\left(\begin{array}{c}{i}_A\\ i_B\\ i_C\end{array}\right)$

根据测得的框架电机机械角度θ_m确定电机电角度θ_e，然后根据i_α、i_β和 电机电角度θ_e，计算得到电机定子绕组电流中的励磁电流分量i_d和力矩电流分 量i_q，计算公式如下：

$\left(\begin{array}{c}{i}_d\\ i_q\end{array}\right)=\left(\begin{array}{cc}{\mathrm{cos\theta }}_e& {\mathrm{sin\theta }}_e\\ -{\mathrm{sin\theta }}_e& {\mathrm{cos\theta }}_e\end{array}\right)·\left(\begin{array}{c}{i}_{\alpha }\\ i_{\beta }\end{array}\right)$

2)速度环PI控制器1

速度环PI控制器为PI调节器，输入为转速误差，转速给定值ω_ref与转速 反馈值ω_m之差，输出为力矩参考值T_ref。转矩参考值T_ref除以电机等效力矩系 数k_t，得到q轴电流的初始给定值i_qref0，如图1所示。

3)电流环PI控制器2

电流环PI控制器包括d轴电流PI控制器，和q轴电流PI控制器。

d轴电流控制器的给定值为0,给定值与d轴电流反馈i_d的差为该控制器的 输入，输出为d轴电压给定信号u_dref。

q轴电流控制器的输入为q轴电流给定值i_qref与q轴电流反馈值i_q的差， 输出为q轴电压给定信号u_qref。

4)驱动电压变换

根据电流环PI控制器的输出u_dref、u_qref和电机电角度θ_e，计算得到两相静 止坐标系下的α，β轴的电压指令值u_α和u_β，计算公式如下：

$\left(\begin{array}{c}{u}_{\alpha }\\ u_{\beta }\end{array}\right)=\left(\begin{array}{cc}{\mathrm{cos\theta }}_e& -{\mathrm{sin\theta }}_e\\ {\mathrm{sin\theta }}_e& {\mathrm{cos\theta }}_e\end{array}\right)·\left(\begin{array}{c}{u}_{dref}\\ u_{qref}\end{array}\right)$

利用两相静止坐标系到三相ABC坐标系下的变换法则，由两相静止坐标系 下的α，β轴的电压指令值u_α和u_β得出电机定子三相相电压的指令值u_A、u_B、 u_C，

则计算公式如下：

$\left(\begin{array}{c}{u}_A\\ u_B\\ u_C\end{array}\right)=\frac{2}{3}·\left(\begin{array}{cc}1& 0\\ -\frac{1}{2}& \frac{\sqrt{3}}{2}\\ -\frac{1}{2}& -\frac{\sqrt{3}}{2}\end{array}\right)·\left(\begin{array}{c}{u}_{\alpha }\\ u_{\beta }\end{array}\right)$

将计算得到的u_A、u_B、u_C通过功率驱动电路驱动永磁同步电机3旋转。

在PI控制模式下，速度环PI控制器得到的q轴电流的初始给定值i_qref0直 接作为上述q轴电流给定值i_qref；在前馈控制模式下，初始给定值i_qref0需要加 上一个补偿值作为q轴电流给定值i_qref。具体如下：

5)机械转矩T_m反馈

作用在框架驱动轴上的转矩T_m由框架转速的角加速度和框架的转动惯量 来获得：

$T_m^{j+1}=J{\stackrel{·}{\omega }}_m^{j+1}$

其中J为框架的转动惯量。当前控制周期框架转速的角加速度计算公式为：

${\stackrel{·}{\omega }}_m^{j+1}=\frac{{\omega }_m^{j+1}-{\omega }_m^j}{T}$

T为控制周期。

框架转角ω_m由相邻两控制周期测得的机械角度θ_m之差，除以控制周期T 得到：

${\omega }_m^{j+1}=\frac{{\theta }_m^{j+1}-{\theta }_m^j}{T}$

6)前馈补偿模块5

由转速控制器输出的力矩参考值T_ref和反馈的框架机械转矩T_m做差，得到 机械转矩误差e，该误差值送入前馈补偿模块5，如图1所示。当前控制周期 的机械转矩反馈值记为T_m，j+1，得到的机械转矩误差值记为e_j+1。前馈补偿模块 的输出为补偿值，该值由三部分构成,如图2所示：

1.误差值e_j+1与补偿系数K₂相乘，作为电流前馈补偿值Δi_qref,j+1的第1 部分；

2.误差值e_j+1与补偿系数K₁相乘,送入存储器，同时，从存储其中读取 出上一补偿周期计算出的该数值，即K₁e_j+1-Nf。

其中，N_f为补偿周期所对应的控制周期数；在本方法中补偿周期为高速 转子的转动周期，如高速转子为6000转/分，补偿周期为0.01s。K₁e_j+1-Nf作为电流前馈补偿值Δi_qref,j+1的第2部分。

3.上一补偿周期的电流补偿值Δi_qref,j+1-Nf乘以系数(1-α)，得到的数值 为电流前馈补偿值Δi_qref,j+1的第3部分。其中α为遗忘因子，α∈[0,1]。

前馈补偿可用下述公式表达：

${\mathrm{\Delta i}}_{qref,j+1}=K_2{e}_{j+1}+K_1{e}_{j+1-N_f}+(1-\alpha ){\mathrm{\Delta i}}_{qref,j+1-N_f}$

N_f为补偿周期所对应的控制周期数，所述的补偿周期为高速转子的转动周 期；

e_j+1-Nf为上一补偿周期的机械转矩误差；

Δi_qref,j+1-Nf为上一补偿周期的电流前馈补偿值，电流前馈补偿初值为0；

补偿系数取值满足：

$0<K_1<\frac{2-\alpha }{k_t}$

0<K₂≤K₁。

6)算法切换模块6

为保证前馈补偿有效提高CMG框架稳态工作时的控制精度，通过计算 CMG框架转速精度，在一段连续的时间长度内，若满足转速精度判据的事件连 续发生了N次，则判定CMG转速进入稳态，此时将前馈补偿模块的输出—— 补偿的电流给定值Δi_qref,j+1，加入到控制系统中，用以消除转子的动不平衡扰动 力矩，此时为前馈补偿模式。反之，则判定CMG框架转速进入暂态，前馈补 偿将被封锁，系统转为PI控制模式。

以N_g为周期，连续计算低速框架转速精度。转速精度的计算方法为：

${\bar{\theta }}_m=\frac{1}{N_g}\underset{k=1}{\overset{N_g}{\Sigma }}{\theta }_m^k$

转速精度为：

$v_G=\frac{|{\bar{\theta }}_m-{\theta }_g|}{{\theta }_g}$

其中，

θ_g：角度增量名义值，即根据转速指令计算出的指令转角值；

实测平均值。

在第i个控制周期，算法切换逻辑为：

判断当前控制状态

如果为PI控制模式，进行如下判断

如果V_G>ε

计数器Count清零，第i个控制周期判断结束，ε为转速精度规范值

如果V_G≤ε，计数器计数值Count+1

判断计数器计数值Count是否大于N

如果Count≤N

第i个控制周期判断结束

如果Count>N

Count清零，切换为前馈补偿模式。

如果为前馈补偿模式，进行如下判断

如果V_G≤ε

计数器Count清零，第i个控制周期判断结束，ε为转速精度规范值

如果V_G>ε，计数器计数值Count+1

判断计数器计数值Count是否大于N

如果Count≤N

第i个控制周期判断结束

如果Count>N

Count清零，切换为PI控制模式。

系统在刚开始工作时，CMG转速一般是不稳定的，因此在此段时间，即在 预设的N_g个控制周期内，设置整个框架控制系统工作在PI控制模式，即按照 双环PI控制系统进行控制；之后根据上述介绍，判断CMG转速是否达到稳态， 判断是否进入前馈补偿模式。对于N_g的取值，如果取值过小，转速采集误差会 导致系统频繁切换，所以N_g取值的下限应根据反馈转速数据中噪声情况确定， 保证对采集信号进行有效滤波。N_g取值过大会使切换判断时间过长，取值的上 限一般应根据对控制力矩陀螺转速响应的具体要求确定。

综上，本发明一种抑制转子动不平衡扰动的控制力矩陀螺框架控制系统在 现有双环PI控制系统(包括速度环PI控制器1、电流环PI控制器2、框架电 机3和CMG框架4)基础上，嵌入前馈补偿模块(5)和算法切换模块(6)进 行控制。

在预设的N_g个控制周期内，设置整个框架控制系统工作在PI控制模式， 即按照双环PI控制系统进行控制；

从N_g+1控制周期开始，在当前控制周期T_j+1，通过算法切换模块6计算当 前控制周期内CMG框架转速精度，根据算法切换逻辑结合框架转速精度，确 定是否需要切换当前控制周期的控制模式，若切换后当前控制周期为前馈补偿 模式，则将速度环PI控制器输出的力矩参考值与反馈的框架电机3的机械转矩 做差，得到当前控制周期的机械转矩误差e_j+1将该机械转矩误差e_j+1输入前馈 补偿模块5，由前馈补偿模块5计算当前控制周期的电流前馈补偿值Δi_qref,j+1， 由算法切换模块6将电流前馈补偿值Δi_qref,j+1加入所述的双环PI控制系统；

若切换后当前控制周期为PI控制模式，则封锁电流前馈补偿，按照双环 PI控制系统进行控制。

本发明一种抑制转子动不平衡扰动的控制力矩陀螺框架控制方法，包括PI 控制模式和前馈控制模式两种控制模式；

(1)从起始控制到预设的N_g个控制周期内，按照PI控制模式对CMG框 架进行控制；

(2)进入第N_g+1个控制周期，设置计数值Count初值为0；

(3)在当前控制周期T_j+1，将转速给定值ω_ref与采集的框架电机的转速值 ω_m做差，根据该差值得到力矩参考值T_ref，将该转矩参考值T_ref除以电机等效 力矩系数k_t，得到q轴电流的初始给定值i_qref0；j初始值为N_g；

(4)计算CMG框架在当前控制周期的转速精度V_G，按照下述逻辑进行 判断：

(4.1)判断当前控制模式，若当前控制周期工作在PI控制模式下，则进 入步骤(4.2)；若工作在前馈补偿模式，则进入步骤(4.3)；

(4.2)判断当前控制周期的CMG框架转速精度V_G是否大于ε，若V_G> ε，则计数值Count清零，当前控制周期控制模式保持不变，当前控制周期判 断结束；否则计数值Count+1，并进一步判断Count是否大于预设的门限次数 N，若Count>N，则计数值Count清零，并将当前控制周期的控制模式切换为 前馈补偿模式；若Count≤N，则当前控制周期控制模式保持不变，当前控制 周期判断结束；

(4.3)判断当前控制周期的CMG框架转速精度V_G是否小于等于ε，若 V_G≤ε，则计数值Count清零，当前控制周期控制模式保持不变，当前控制周 期判断结束；否则计数值Count+1，并进一步判断Count是否大于预设的门限 次数N，若Count>N，则计数值Count清零，并将当前控制周期的控制模式切 换为PI控制模式；若Count≤N，则当前控制周期控制模式保持不变，当前控 制周期判断结束；

上述，ε为转速精度规范值；

(5)根据步骤(4)的结果，若切换后当前控制周期为前馈补偿模式，则 执行步骤(6)、步骤(7)，利用步骤(7)中当前控制周期的电流前馈补偿值 Δi_qref,j+1对步骤(3)中得到的q轴电流的初始给定值i_qref0进行补偿，并利用补 偿后的电流值通过框架电机对CMG框架进行控制，进入下一控制周期，令j 的取值加1，转步骤(3)；若切换后当前控制周期为PI控制模式，则封锁步骤 (6)、步骤(7)，利用步骤(3)中得到的q轴电流的初始给定值i_qref0通过框 架电机对CMG框架进行控制，进入下一控制周期，令j的取值加1，转步骤(3)。

(6)根据当前控制周期框架转速的角加速度和框架的转动惯量，得到作用 在CMG框架上的机械转矩T_m；当前控制周期框架转速角加速度由当前周期的 转速与上一周期的转速计算得到；将步骤(3)中的力矩参考值T_ref与T_m做差， 得到当前控制周期的机械转矩误差e_j+1；

(7)根据机械转矩误差e_j+1计算当前控制周期的电流前馈补偿值Δi_qref,j+1；

本发明未详细说明部分属于本领域技术人员公知常识。