[发明专利]一种磁悬浮飞轮转速控制方法

权利要求书

1.一种磁悬浮飞轮转速控制方法，其特征在于实现步骤如下：

(1)检测飞轮转速值

采用光电码盘利用M/T法进行测速，在测速程序中对光电码盘信号进行判断，当 光电码盘的高电平与低电平保持一定时间后触发计数器进行计数，以减少高频干扰信号 的影响，最后根据M/T法检测的光电码盘脉冲数与高频时钟数进行转换即得到当前时刻 磁悬浮飞轮转速值n(k)＝60f*m1/[P*(m2+m3)]，其中，f是高频时钟脉冲的频率，P是码 盘一周发出的脉冲数，在规定的时间Tc内，分别计取光电码盘的脉冲个数m1和高频时 钟的脉冲个数m2，m3是Tc结束后到码盘下一个脉冲上升沿的时间间隔；

(2)对所述当前时刻磁悬浮飞轮转速值进行模糊自适应kalman滤波

首先根据磁悬浮飞轮电机模型，取状态向量x₁(k)＝n(k)，x₂(k)＝x₁(k+1)-Au(k)，其 中，x₁(k)，x₂(k)为系统状态向量，n(k)为步骤(1)得到的当前时刻磁悬浮飞轮转速值， A为根据系统参数计算得到的控制系数，u(k)为系统输出控制量，则系统方程可写为如 下的状态空间方程式：

x1(k+1)x2(k+1)=01-D-F*x1(k)x2(k)+AB-A*F*u(k)=G*x(k)+H*u(k)n(k)=10*x1(k)x2(k)=C*x(k),]]>式中，D、F、A、B、 G、H、C均为常数矩阵，D、F、A、B为将系统方程转换为状态方程后得到的控制系统参 数的中间变量值，G为系统矩阵，H为输入矩阵，C为输出矩阵；

G=01-ed1T*ed2Ted1T+ed2T,]]>

H=30*keJ*L*π(d2*ed1T-d1*ed2T+d1-d2)d1*d2*(d1-d2)30*keJ*L*π(d1*ed1T*ed2T-d2*ed1T*ed2T+d2*ed2T-d1*ed1T)d1*d2*(d1-d2)-30*keJ*L*π(d2*ed1T-d1*ed2T+d1-d2)d1*d2*(d1-d2)*(-ed1T-ed2t)]]>

C＝[1  0]，其中，J为磁悬浮飞轮转动惯量，k_e为反电动势系数，L为电机绕组电 感，d₁，d₂为系统特征方程两根；e为自然对数底数，T为采样时间；

kalman滤波器的状态估计方程：x^(k)=x^(k|k-1)+K(k)*[n(k)-C*x^(k|k-1)],]]>式中， 为状态估计值；为状态预报值；K(k)为滤波增益矩阵；kalman滤波的滤 波增益矩阵K(k)可按下式计算：K(k)＝δ(k)*P(k|k-1)*C^T*(C*P(k|k-1)*C^T+r(k))^-1， P(k|k-1)＝G*P(k-1)*G^T+H*Q*H^T，P(k)＝(I-K(k)*C)*P(k|k-1)其中， δ(k)=c(k),c(k)>=11c(k)<1,]]>c(k)＝η(k)/τ(k)，η(k)＝E(k)-ε*r-C*G*C^T， τ(k)＝C*G*P(k)*G^T*C^T，E(k)=e02k=0[ρ*E(k-1)+e(k)2]1+ρk>=1,]]>e(k)=n(k)-n^(k|k-1),]]>式中，δ(k)为衰退因子矩阵，P(k|k-1)为一步预测均方误差，C为输出矩阵，P(k)为估 计均方误差，r为量测噪声方差阵，G为系统矩阵，H为输入矩阵，Q为系统噪声方差 阵，P(k)为估计均方误差，K(k)为滤波增益矩阵，衰退因子矩阵δ(k)由柔化因子ε和 遗忘因子ρ确定，e(k)为实测转速与估计转速偏差，e₀初始时刻转速偏差，ε通过模糊 自适应调节确定，c(k)为衰退量，E(k)为误差矩阵，η(k)为当前时刻误差平方量、τ (k)为当前时刻估计偏差方差量；

(3)根据滤波后的转速值进行转速控制

磁悬浮飞轮电机控制系统的转速控制通过外环转速环，内环电流环的双环控制方法 实现，转速环与电流环都采用变积分PID控制方法实现，其中转速环根据经滤波后的转 速值与转速参考值进行转速环控制，转速环控制参数根据转速参考与转速偏差绝对值进 行自适应调节，转速环控制输出电流参考值，用于磁悬浮飞轮电机绕组电流控制；电流 环控制程序根据转速环输出的电流参考值与电流反馈值进行磁悬浮飞轮电机绕组电流 控制，电流环控制参数要根据磁悬浮飞轮运行状态、参考转速值与电流偏差绝对值实时 调节，电流环输出控制量直接用于驱动电机运行。

2.根据权利要求1所述的一种磁悬浮飞轮转速控制方法，其特征在于：步骤(2)所 述柔化因子ε通过模糊自适应调节确定的方法如下：

模糊控制器采用一阶T-S模型，令控制器的输入为ζ＝e(k)²，隶属度函数为： 其中t₁，t₂，t₃，t₄为输入参数论域中的点，模糊控制规 则如下：