CN103543636B - 一种动力调谐陀螺仪解耦伺服控制回路 - Google Patents

Abstract

本发明公开了一种动力调谐陀螺仪解耦伺服控制回路，由一个陀螺仪、两个力矩器、一个控制器和一个两输入输出解耦器组成。本发明设计的控制器包含一个二输入控制解耦器、两个相同的二阶积分器和两个相同的滞后超前环节，为2×2维多输入多输出传递函数矩阵，可实现对两个交链回路的解耦；两个积分环节使捷联惯性系统成为一个II型系统，二阶积分环节可消除与常值角速度变化率有关的误差，从而提高伺服回路系统的稳态精度；滞后超前环节可提高系统低频段的动态增益，有利于减小动态误差。在伺服控制回路中增加输出解耦环节，可克服由于伺服回路的两个电流输出值与角速度之间的交链问题，提高捷联惯性系统的输出精度。

Description

一种动力调谐陀螺仪解耦伺服控制回路

技术领域

本发明涉及一种捷联惯性测量装置的伺服控制回路，尤其涉及一种动力调谐陀螺仪解耦伺服控制回路，属于用于高精度角速度测量的航空、航天领域。

背景技术

动力调谐陀螺仪是一种用挠性元件对高速旋转转子构成万向接头式支承的两自由度陀螺仪。在调谐转速下，平衡环的动态力矩抵消了挠性支承德弹性约束力矩，使陀螺转子成为不受约束的自由转子，因此称为动力调谐陀螺仪（简称动调陀螺仪）。

捷联系统中应用的动调陀螺仪与载体固连，载体的角运动将直接加到陀螺仪上。由于开路状态的动调陀螺仪只限于在小角度范围内工作，因此在捷联系统中应用的动力调谐陀螺仪，一定要将其输出通过再平衡回路送到相应的力矩器，使陀螺仪工作于闭路状态。在这种条件下，力矩器对转子施加力矩，驱使转子跟踪壳体运动，动调陀螺仪的失调角始终保持在零附近，通过输送到力矩器的电流（或电压、脉冲频率）来测量载体绕陀螺仪输出轴的角速度。动调陀螺仪是一个两自由度陀螺仪，其输出环节和进动环节都存在交链和耦合。为设计方便，国内现有的动调陀螺仪伺服回路都简化看作单输入单输出系统，但其缺点是由于没有进行解耦会引起陀螺仪的高频章动运动，使系统输出噪声较大。虽然此系统已在不同型号中得到应用，但随着高精度角速度测量的需求越来越迫切，需重新展开对动调陀螺仪伺服回路的控制器设计。

发明内容

本发明的技术解决问题：克服现有技术的不足，提供一种动力调谐陀螺仪伺服控制回路，本发明通过对陀螺仪两个伺服回路之间的控制解耦以克服高频章动运动，通过输出解耦以消除两个通道之间的输出交链以提高系统的输出精度。

本发明的技术解决方案：一种动力调谐陀螺仪解耦伺服控制回路，由一个陀螺仪、两个力矩器、一个控制器和一个两输入输出解耦器组成，当动力调谐陀螺仪的安装载体沿动力调谐陀螺仪两个输入轴方向有角速度输入时，动力调谐陀螺仪的壳体相对转子在两个输入轴方向分别偏离一个角度从而产生两路偏差信号，动力调谐陀螺仪两个输入轴上的传感器分别检测到两路偏差信号并形成两路电信号，控制器中的两输入控制解耦器将两个传感器形成的电信号进行解耦得到两路电信号,两路电信号作为控制器中二阶积分环节和超前滞后环节的输入量，控制器中二阶积分环节和超前滞后环节的两路输出量分别反馈至与输入电信号对应输入轴正交方向上的力矩器，两个力矩器根据反馈的电信号分别产生再平衡力矩使陀螺仪转子进动以消除两个输入轴方向的偏差信号，控制器最终输出的两路电信号经过一个两输入输出解耦器进行解耦，两输入输出解耦器的解耦结果作为动力调谐陀螺仪的输出结果，所述控制器由一个两输入控制解耦器、两个相同的二阶积分环节和两个相同的超前滞后环节组成，控制器的传递函数为：

$C\left(s\right)=\left[\begin{array}{cc}\frac{J_B{s}^2}{K_{\mathrm{tx}}}& \frac{\mathrm{Hs}+\mathrm{\λ}}{K_{\mathrm{tx}}}\\ -\frac{\mathrm{Hs}+\mathrm{\λ}}{K_{\mathrm{ty}}}& \frac{J_B{s}^2}{K_{\mathrm{ty}}}\end{array}\right]\×\left[\begin{array}{cc}\frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}& 0\\ 0& \frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}\end{array}\right]$

其中， $\left[\begin{array}{cc}\frac{J_B{s}^2}{K_{\mathrm{tx}}}& \frac{\mathrm{Hs}+\mathrm{\λ}}{K_{\mathrm{tx}}}\\ -\frac{\mathrm{Hs}+\mathrm{\λ}}{K_{\mathrm{ty}}}& \frac{J_B{s}^2}{K_{\mathrm{ty}}}\end{array}\right]$ 为两输入控制解耦器的传递函数，J_B为动力调谐陀螺仪的等效赤道转动惯量，H为动力调谐陀螺仪的角动量，λ为动力调谐陀螺仪的正交阻尼系数，K_tx、K_ty分别为动力调谐陀螺仪两个输入轴方向的力矩器系数；

k_c为伺服回路的放大倍数；

为二阶积分环节的传递函数；

为超前滞后环节的传递函数，T_c1、T_c2为控制器中频段的时间常数，T_c1<T_c2。

所述两输入输出解耦器的传递函数为 $\left[\begin{array}{cc}\frac{J_{B}s}{K_{\mathrm{tx}}}& \frac{H}{K_{\mathrm{tx}}}\\ -\frac{H}{K_{\mathrm{ty}}}& \frac{J_{B}s}{K_{\mathrm{ty}}}\end{array}\right],$ 其中，J_B为动力调谐陀螺仪的等效赤道转动惯量，H为动力调谐陀螺仪的角动量，K_tx、K_ty分别为动力调谐陀螺仪两个输入轴方向的力矩器系数。

本发明与现有技术相比的优点如下：

（1）本发明设计的解耦伺服控制回路，其控制器为2×2维多输入多输出传递函数矩阵，包含一个二输入控制解耦器、两个相同的二阶积分器和两个相同的滞后超前环节，可实现对两个交链回路的解耦；4个元素的分母阶次大于分子阶次，有利于工程实现；采用2个积分环节，使系统成为一个II型系统，采用二阶积分环节可消除与常值角速度变化率有关的误差，从而提高伺服回路系统的稳态精度；采用滞后超前环节，可提高捷联惯性系统低频段的动态增益，有利于减小动态误差。

（2）本发明首次在伺服控制回路中增加输出解耦环节，可克服由于伺服回路的两个电流输出值与角速度之间的交链问题，实现载体角运动与输出测量角速度之间严格一一对应，提高捷联惯性系统的输出精度。

附图说明

图1为本发明伺服控制回路的组成结构图；

图2为本发明伺服回路控制器的实现原理图；

图3为本发明伺服控制回路开环幅值和相位伯德图；

图4为控制器离散化后回路闭合时的实测结果；

图5为控制器输入的频谱分析结果；

图6为控制器输出的频谱分析结果。

具体实施方式

动力调谐陀螺仪是由驱动马达、支承系统、角度传感器、陀螺力矩器、陀螺转子、密封壳体等主要部件组成。驱动马达通过驱动轴带动支承系统和陀螺转子以恒定的角速度旋转，保证陀螺具有需要的调谐转速和角动量。在仪表工作时，弹性支承的正弹性力矩可以完全被平衡环的振荡运动产生的动力反弹性力矩所抵消，使陀螺转子成为不受约束的自由转子。角度传感器用来将陀螺转子相对仪表壳体绕两个正交输出轴的转角转换成相应的电压信号。力矩器是对陀螺转子施加力矩的装置。陀螺转子是产生角动量H的惯性质量，由飞轮、力矩器的永磁环、传感器的动极板及角限动器所组成。因此，陀螺转子又是力矩器、传感器及角限动器的组成部分。

捷联系统中应用的动调陀螺仪与载体固连，载体的角运动将直接加到陀螺仪上。由于开路状态的动调陀螺仪只限于在小角度范围内工作，因此在捷联系统中应用的动调陀螺仪，一定要将其输出通过再平衡回路送到相应的力矩器，使陀螺仪工作于闭路状态。在这种条件下，力矩器对转子施加力矩，驱使转子跟踪壳体运动，陀螺仪的失调角始终保持在零附近，通过输送到力矩器的电流（或电压、脉冲频率）来测量载体绕陀螺仪输出轴的角速度。

动调陀螺仪转子在壳体坐标系OX₀Y₀Z₀中的运动微分方程为：

$\left\{\begin{array}{c}{J}_B\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&alpha;}}+\mathrm{\&delta;}\stackrel{\&CenterDot;}{\mathrm{\&alpha;}}+\mathrm{\&Delta;K\&alpha;}+H\stackrel{\&CenterDot;}{\mathrm{\&beta;}}+\mathrm{\&lambda;\&beta;}=M_X-J_B{\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}-H^{*}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0}+M_{X_0}^{*}\\ J_B\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&beta;}}+\mathrm{\&delta;}\stackrel{\&CenterDot;}{\mathrm{\&beta;}}+\mathrm{\&Delta;K\&beta;}-H\stackrel{\&CenterDot;}{\mathrm{\&alpha;}}-\mathrm{\&lambda;\&alpha;}=M_Y-J_B{\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0}+H^{*}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}+M_{Y_0}^{*}\end{array}\right.---\left(1\right)$

式中

J_B=J_e+a/2——动力调谐陀螺仪的等效赤道转动惯量；

H=(J_z+a)Ω——动力调谐陀螺仪的角动量；

ΔK=K₀-(a-c/2)Ω²——剩余刚度；

λ=(δ+C₁/2)Ω——动力调谐陀螺仪的正交阻尼系数；

H^*=(J_z+c/2)Ω——动力调谐陀螺仪的输入等效角动量；

$\begin{array}{c}{M}_{X_0}^{*}=[-\frac{a}{2}({\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}+\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&alpha;}})-(a\stackrel{\&CenterDot;}{\mathrm{\&beta;}}+\frac{c}{2}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0})\mathrm{\&Omega;}+(a-\frac{c}{2}){\mathrm{\&Omega;}}^2\mathrm{\&alpha;}]\cos 2\mathrm{\&Omega;t}\\ +[-\frac{a}{2}({\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0}+\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&beta;}})+(a\stackrel{\&CenterDot;}{\mathrm{\&alpha;}}+\frac{c}{2}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{X_0})\mathrm{\&Omega;}+(a-\frac{c}{2}){\mathrm{\&Omega;}}^2\mathrm{\&beta;}]\sin 2\mathrm{\&Omega;t}\end{array}$ ——对X₀轴的二次谐波力矩；

$\begin{array}{c}{M}_{Y_0}^{*}=[-\frac{a}{2}({\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}+\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&alpha;}})-(a\stackrel{\&CenterDot;}{\mathrm{\&beta;}}+\frac{c}{2}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0})\mathrm{\&Omega;}+(a-\frac{c}{2}){\mathrm{\&Omega;}}^2\mathrm{\&alpha;}]\sin 2\mathrm{\&Omega;t}\\ -[-\frac{a}{2}({\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0}+\stackrel{\&CenterDot;\&CenterDot;}{\mathrm{\&beta;}})+(a\stackrel{\&CenterDot;}{\mathrm{\&alpha;}}+\frac{c}{2}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{X_0})\mathrm{\&Omega;}+(a-\frac{c}{2}){\mathrm{\&Omega;}}^2\mathrm{\&beta;}]\cos 2\mathrm{\&Omega;t}\end{array}$ ——对Y₀轴的二次谐波力矩；

a──平衡环赤道转动惯量；

c──平衡环极转动惯量；

δ──支承杆的阻尼系数；

J_z──转子极转动惯量；

J_e──转子赤道转动惯量。

两自由度动力调谐陀螺仪存在耦合，其传递函数如式(2)。

$\begin{array}{c}\left[\begin{array}{c}\mathrm{\&alpha;}\left(s\right)\\ \mathrm{\&beta;}\left(s\right)\end{array}\right]=\left[\begin{array}{cc}-\frac{H}{\mathrm{Hs\&lambda;}}& \frac{H^2(J_B\mathrm{\&lambda;}-H^{*}\mathrm{\&delta;})s}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}\\ -\frac{H^2(J_B\mathrm{\&lambda;}-H^{*}\mathrm{\&delta;})s}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}& -\frac{H}{\mathrm{Hs}+\mathrm{\&lambda;}}\end{array}\right]\left[\begin{array}{c}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}\left(s\right)\\ {\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0}\left(s\right)\end{array}\right]\\ +\left[\begin{array}{cc}\frac{J_B{H}^2{s}^2}{{(\mathrm{Hs}+\mathrm{\&lambda;}}^2(J_B^2{s}^2+H^2)}& \frac{H^2}{(\mathrm{Hs}+\mathrm{\&lambda;})(J_B^2{s}^2+H^2)}\\ \frac{H^2}{(\mathrm{Hs}+\mathrm{\&lambda;})(J_B^2{s}^2+H^2)}& \frac{J_B{H}^2{s}^2}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}\end{array}\right]\left[,\begin{array}{c}{M}_X\left(s\right)\\ M_Y\left(s\right)\end{array}\right]\end{array}---\left(2\right)$

如图1所示，伺服控制回路由一个陀螺仪、两个力矩器、一个控制器和一个两输入输出解耦器组成，当动力调谐陀螺仪的安装载体沿动力调谐陀螺仪两个输入轴方向有角速度输入时，动力调谐陀螺仪的壳体相对转子在两个输入轴方向分别偏离一个角度从而产生两路偏差信号，动力调谐陀螺仪两个输入轴上的传感器分别检测到两路偏差信号并形成两路电信号，控制器中的两输入控制解耦器将两个传感器形成的电信号进行解耦得到两路电信号,两路电信号作为控制器中二阶积分环节和超前滞后环节的输入量，控制器中二阶积分环节和超前滞后环节的两路输出量分别反馈至与输入电信号对应输入轴正交方向上的力矩器，两个力矩器根据反馈的电信号分别产生再平衡力矩使陀螺仪转子进动以消除两个输入轴方向的偏差信号，控制器最终输出的两路电信号经过一个两输入输出解耦器进行解耦，两输入输出解耦器的解耦结果作为动力调谐陀螺仪的输出结果，

控制器由一个两输入控制解耦器、两个相同的二阶积分环节和两个相同的超前滞后环节组成，如图2所示，控制器的传递函数为：

$\begin{array}{c}C\left(s\right)=\left[\begin{array}{cc}{C}_{11}(s& C_{12}\left(s\right)\\ C_{21}\left(s\right)& C_{22}\left(s\right)\end{array}\right]=\left[\begin{array}{cc}\frac{k_c{J}_B/K_t(\frac{s}{T_{c1}}+1)}{\frac{s}{T_{c2}}+1}& \frac{k_c/K_t(\frac{s}{T_{c1}}+1)(\mathrm{Hs}+\mathrm{\&lambda;})}{s^2(\frac{s}{T_{c2}}+1)}\\ \frac{k_c/K_t(\frac{s}{T_{c1}}+1)(\mathrm{Hs}+\mathrm{\&lambda;})}{s^2(\frac{s}{T_{c2}}+1)}& \frac{k_c{J}_B/K_t(\frac{s}{T_{c1}}+1)}{\frac{s}{T_{c2}}+1}\end{array}\right]\\ =\left[\begin{array}{cc}\frac{J_B{s}^2}{K_{\mathrm{tx}}}& \frac{\mathrm{Hs}+\mathrm{\&lambda;}}{K_{\mathrm{tx}}}\\ -\frac{\mathrm{Hs}+\mathrm{\&lambda;}}{K_{\mathrm{ty}}}& \frac{J_B{s}^2}{K_{\mathrm{ty}}}\end{array}\right]\&times;\left[\begin{array}{cc}\frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}& 0\\ 0& \frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}\end{array}\right]\end{array}---\left(3\right)$

上式包含图1中的二输入控制解耦器传递函数矩阵、二阶积分器和滞后超前环节传递函数矩阵。

其中， $\left[\begin{array}{cc}\frac{J_B{s}^2}{K_{\mathrm{tx}}}& \frac{\mathrm{Hs}+\mathrm{\&lambda;}}{K_{\mathrm{tx}}}\\ -\frac{\mathrm{Hs}+\mathrm{\&lambda;}}{K_{\mathrm{ty}}}& \frac{J_B{s}^2}{K_{\mathrm{ty}}}\end{array}\right]$ 为两输入控制解耦器的传递函数，J_B为动力调谐陀螺仪的等效赤道转动惯量，H为动力调谐陀螺仪的角动量，λ为动力调谐陀螺仪的正交阻尼系数，K_tx、K_ty分别为动力调谐陀螺仪两个输入轴方向的力矩器系数；

kc为伺服回路的放大倍数；

为二阶积分环节的传递函数；

为超前滞后环节的传递函数，T_c1、T_c2为控制器中频段的时间常数，T_c1<T_c2。

捷联系统角速度测量值直接取自动力调谐陀螺仪的输出电流值I_x、I_y，利用I/F电路转换为频率信号，其比例系数分别为K_fx、K_fy。由于电流与角速度之间的关系为：

$\begin{array}{c}\left[\begin{array}{c}{I}_x\\ I_y\end{array}\right]=-{\left[\begin{array}{cc}\frac{K_{\mathrm{tx}}{J}_B{H}^2{s}^2}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}& -\frac{K_{\mathrm{ty}}{H}^2}{(\mathrm{Hs}+\mathrm{\&lambda;})(J_B^2{s}^2+H^2)}\\ \frac{K_{\mathrm{tx}}{H}^2}{(\mathrm{Hs}+\mathrm{\&lambda;})(J_B^2{s}^2+H^2)}& \frac{K_{\mathrm{ty}}{J}_B{H}^2{s}^2}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}\end{array}\right]}^{-1}\\ \&times;\left[\begin{array}{cc}-\frac{H}{\mathrm{Hs}+\mathrm{\&lambda;}}& \frac{H^2(J_B\mathrm{\&lambda;}{-H}^{*}\mathrm{\&delta;}s}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}\\ -\frac{H^2(J_B\mathrm{\&lambda;}-H^{*}\mathrm{\&delta;})s}{{(\mathrm{Hs}+\mathrm{\&lambda;})}^2(J_B^2{s}^2+H^2)}& -\frac{H}{\mathrm{Hs}+\mathrm{\&lambda;}}\end{array}\right]\left[\begin{array}{c}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}\left(s\right)\\ {\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0\left(s\right)}\end{array}\right]=\left[\begin{array}{cc}\frac{J_{B}s}{K_{\mathrm{tx}}}& \frac{H}{K_{\mathrm{tx}}}\\ -\frac{H}{K_{\mathrm{ty}}}& \frac{J_{B}s}{K_{\mathrm{ty}}}\end{array}\right]\left[\begin{array}{c}{\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{X_0}\left(s\right)\\ {\stackrel{\&CenterDot;}{\mathrm{\&phi;}}}_{Y_0}\left(s\right)\end{array}\right]\end{array}---\left(4\right)$

可以看出，输出电流值I_x、I_y与角速度之间并不是严格一一对应。测量值除包含相应的角速度外，还包含另一个输出轴的角加速度误差项，为补偿此项误差，可在输出电路中增加输出解耦环节。

从式（4）中可以看出，本发明设计的两输入输出解耦器的传递函数为 $\left[\begin{array}{cc}\frac{J_{B}s}{K_{\mathrm{tx}}}& \frac{H}{K_{\mathrm{tx}}}\\ -\frac{H}{K_{\mathrm{ty}}}& \frac{J_{B}s}{K_{\mathrm{ty}}}\end{array}\right],$ 其中，J_B为动力调谐陀螺仪的等效赤道转动惯量，H为动力调谐陀螺仪的角动量，K_tx、K_ty分别为动力调谐陀螺仪两个输入轴方向的力矩器系数。

${\left[\begin{array}{cc}\frac{J_{B}s}{K_{\mathrm{tx}}}& \frac{H}{K_{\mathrm{tx}}}\\ -\frac{H}{K_{\mathrm{ty}}}& \frac{J_{B}s}{K_{\mathrm{ty}}}\end{array}\right]}^{-1}=\left[\begin{array}{cc}\frac{K_{\mathrm{tx}}{J}_{B}s}{J_B^2{s}^2+H^2}& -\frac{K_{\mathrm{ty}}H}{J_B^2{s}^2+H^2}\\ \frac{K_{\mathrm{tx}}H}{J_B^2{s}^2+H^2}& \frac{K_{\mathrm{ty}}{J}_{B}s}{J_B^2{s}^2+H^2}\end{array}\right]\&ap;\left[\begin{array}{cc}\frac{K_{\mathrm{tx}}{J}_{B}s}{H^2}& -\frac{K_{\mathrm{ty}}}{H}\\ \frac{K_{\mathrm{tx}}}{H}& \frac{K_{\mathrm{ty}}{J}_{B}s}{H^2}\end{array}\right]---\left(5\right)$

即输出方程为： $\left[\begin{array}{c}{\mathrm{\&omega;}}_x\\ {\mathrm{\&omega;}}_y\end{array}\right]=\left[\begin{array}{cc}\frac{K_{\mathrm{tx}}{J}_{B}s}{H^2}& -\frac{K_{\mathrm{ty}}}{H}\\ \frac{K_{\mathrm{tx}}}{H}& \frac{K_{\mathrm{ty}}{J}_{B}s}{H}\end{array}\right]\left[\begin{array}{c}{I}_x\\ I_y\end{array}\right]---\left(6\right)$

此时，动力调谐陀螺仪的开环传递函数为：

$N\left(s\right)=\left[\begin{array}{cc}{N}_1\left(s\right)& N_2\left(s\right)\\ -N_2\left(s\right)& N_1\left(s\right)\end{array}\right]=\left[\begin{array}{cc}\frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}& 0\\ 0& \frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}\end{array}\right]---\left(7\right)$

可以看出，N₂(s)=0，N₁(s)的幅值和相位伯德图如图3所示。系统的相位裕度为47.5°（ω_c=156rad/s），幅值裕度为16.9dB（ω_m=738rad/s）。对控制器进行离散化后的实测结果如图4所示，对闭合以后Yiz轴控制器输入、输出信号进行频谱分析，如图5和图6所示，从图5、6可以看出，本发明所控制器具有较好的快速性，并且噪声幅值较小。

本发明未详细描述内容为本领域技术人员公知技术。

Claims (1)

1.一种动力调谐陀螺仪解耦伺服控制回路，其特征在于：由一个陀螺仪、两个力矩器、一个控制器和一个两输入输出解耦器组成，当动力调谐陀螺仪的安装载体沿动力调谐陀螺仪两个输入轴方向有角速度输入时，动力调谐陀螺仪的壳体相对转子在两个输入轴方向分别偏离一个角度从而产生两路偏差信号，动力调谐陀螺仪两个输入轴上的传感器分别检测到两路偏差信号并形成两路电信号，控制器中的两输入控制解耦器将两个传感器形成的电信号进行解耦得到两路电信号,两路电信号作为控制器中二阶积分环节和超前滞后环节的输入量，控制器中二阶积分环节和超前滞后环节的两路输出量分别反馈至与输入电信号对应输入轴正交方向上的力矩器，两个力矩器根据反馈的电信号分别产生再平衡力矩使陀螺仪转子进动以消除两个输入轴方向的偏差信号，控制器最终输出的两路电信号经过一个两输入输出解耦器进行解耦，两输入输出解耦器的解耦结果作为动力调谐陀螺仪的输出结果，所述控制器由一个两输入控制解耦器、两个相同的二阶积分环节和两个相同的超前滞后环节组成，控制器的传递函数为：

$C\left(s\right)=\left[\begin{array}{cc}\frac{J_B{s}^2}{K_{tx}}& \frac{Hs+\mathrm{\&lambda;}}{K_{tx}}\\ -\frac{Hs+\mathrm{\&lambda;}}{K_{ty}}& \frac{J_B{s}^2}{K_{ty}}\end{array}\right]\&times;\left[\begin{array}{cc}\frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}& 0\\ 0& \frac{k_c(\frac{s}{T_{c1}}+1)}{s^2(\frac{s}{T_{c2}}+1)}\end{array}\right]$

其中， $\left[\begin{array}{cc}\frac{J_B{s}^2}{K_{tx}}& \frac{Hs+\mathrm{\&lambda;}}{K_{tx}}\\ -\frac{Hs+\mathrm{\&lambda;}}{K_{ty}}& \frac{J_B{s}^2}{K_{ty}}\end{array}\right]$ 为两输入控制解耦器的传递函数，J_B为动力调谐陀螺仪的等效赤道转动惯量，H为动力调谐陀螺仪的角动量，λ为动力调谐陀螺仪的正交阻尼系数，K_tx、K_ty分别为动力调谐陀螺仪两个输入轴方向的力矩器系数；

k_c为伺服回路的放大倍数；

为二阶积分环节的传递函数；

为超前滞后环节的传递函数，T_c1、T_c2为控制器中频段的时间常数，T_c1<T_c2；

所述两输入输出解耦器的传递函数为 $\left[\begin{array}{cc}\frac{J_{B}s}{K_{tx}}& \frac{H}{K_{tx}}\\ -\frac{H}{K_{ty}}& \frac{J_{b}s}{K_{ty}}\end{array}\right].$