一种提高快反镜稳定平台扰动抑制能力的控制方法与流程

本发明属于惯性稳定控制领域，具体的涉及一种提高快反镜稳定平台扰动抑制能力的控制方法，主要用于隔离基座扰动，提升运动平台光电跟踪设备跟踪性能。

背景技术：

在光电跟踪设备中，由于快反镜具有惯性小、带宽高的特性，已广泛用于实现精跟踪控制回路。运动载体上的光电跟踪设备会受到载体扰动的影响，从而导致跟踪性能的大幅下降，例如在星地间光通信设备中，卫星的高带宽抖动会降低通信链路的稳定性。利用快反镜平台来实现光路的稳定和对准是提高跟踪性能的有效手段。在控制方法上，传统的提高快反镜平台扰动抑制能力的方法主要依靠陀螺和CCD实现双回路稳定，陀螺用于敏感惯性空间的速度，有力地提高了快反镜的扰动抑制能力。文献《Inertial sensor-based multi-loop control of fast steering mirror for line of sight stabilization》(Optical Engineering，Vol(55)，2016)利用加速度计、陀螺和CCD实现三环稳定，进一步提高快反镜稳定能力。但是，由于CCD的低采样率、延时特性和传感器数据噪声，当系统在经受不确定的外部扰动时，其扰动抑制能力依旧存在不足。因此，需进一步考虑提升快反镜稳定平台的扰动抑制能力的控制方法。

技术实现要素：

针对当前快反镜稳定平台的扰动抑制能力不足，无法满足更高精度的稳定控制需求，本发明提出了一种提高快反镜稳定平台扰动抑制能力的控制方法，该方法在加速度、速度和位置三环闭环后，利用扰动观测补偿器对扰动加速度进行观测和估计，然后对之进行前馈补偿，从而抵消部分扰动力矩，进一步提高稳定平台稳定能力。

为实现本发明的目的，本发明提供一种提高快反镜稳定平台扰动抑制能力的控制方法，具体实施步骤如下：

步骤(1)：在快反镜稳定平台的两偏转轴上分别安装陀螺和加速度计，用以分别敏感平台两轴在惯性空间运动的角速度和角加速度。这里的速度和加速度的采样频率一般较高，用以实现高带宽内环；

步骤(2)：由于快反镜系统是一个线性系统，通过频率响应测试仪可对平台的加速度频率对象特性进行测试，输入为控制器输出值，输出为加速度计采样值。高采样率可获得较高精度的加速度对象模型G_a(s)，用于实现高带宽加速度环；

步骤(3)：在获取到对象模型G_a(s)基础上，设计加速度控制器C_a(s)实现加速度闭环，然后设计速度控制器C_v(s)实现速度反馈闭环，最后利用图像传感器CCD实现位置控制器C_p(s)和位置闭环，这样就实现了传统的三环闭环控制；

步骤(4)：在加速环内添加扰动观测器是快反镜稳定平台的测量对象模型，是真实对象模型G_a(s)的近似。把加速度控制器的输出同时分别输入给G_a(s)和这样利用两者的输出量做差，可观测出扰动角加速度量；

步骤(5)：设计前馈补偿控制器C_f(s)，把观测出的扰动角加速度量转换为控制器输出量来进行前馈补偿，从而实现对扰动加速度，也就是扰动力矩的抵消。

其中，步骤(3)中考虑到加速度对象模型中的二次微分环节，为了避免加速度控制器中出现的二次积分而导致系统饱和，加速度控制器C_a(s)设计为滞后控制器，模型参考如下：

其中，K_a为控制器增益，T_e为加速度对象模型中滞后因子，T₁为滞后补偿因子，加速度闭环后，改善了被控对象特性，从而速度控制器C_v(s)和位置控制器C_p(s)可设计为PI控制器。

其中，步骤(5)中设计前馈补偿控制器C_f(s)时，为了避免加速度计在低频时噪声过大，信噪比较低，从而导致系统输出饱和，前馈补偿控制器C_f(s)设计为如下带二阶滤波环节的控制器模型：

其中，K_f为前馈控制器增益，T_e为加速度对象模型中滞后因子，w_f为二阶滤波器滤波带宽因子，ξ_f二阶滤波器滤波阻尼因子，当前馈补偿器设计为如上模型后，整个扰动观测补偿器呈现一个超前滞后校正特性，从而实现扰动抑制能力的提升。

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

(1)相对当前最新的三闭环控制方法，本发明引入扰动观测补偿器方法，对扰动力矩进行观测和估计，然后进行前馈，可极大地发挥前馈控制效果，进一步有力地提升了系统扰动抑制能力，减少扰动抑制残差；

(2)本发明是从控制算法上对系统进行优化，无需再另加传感器，保证了系统原有特性，并节约了成本；

(3)本发明思路清晰，结构简单，在工程易于实现，特别是在一些扰动根本无法测量的情况下，可很好地发挥其优势。

附图说明

图1是本发明的一种提高快反镜稳定平台扰动抑制能力的控制方法的控制框图。

图2是本发明的一种提高快反镜稳定平台扰动抑制能力的控制方法的稳定误差对比图。

图3是本发明的相对于传统三闭环控制方法的整体抑制能力对比图。

具体实施方式

以下结合附图对本发明的具体实施方式做详细说明。

如附图1所示是一种提高快反镜稳定平台扰动抑制能力的控制方法的控制框图，其中包括扰动观测补偿器内回路、加速度回路、速度回路、CCD位置回路；利用扰动观测补偿器控制方法和传统的三闭环控制方法相结合，进一步以对加速度的观测估计前馈，从而提高系统的扰动抑制能力。采用所述装置实现前馈控制方法的具体实施步骤如下：

步骤(1)：在快反镜稳定平台的两偏转轴上分别安装陀螺和加速度计，用以分别敏感平台两轴在惯性空间运动的角速度和角加速度。这里的速度和加速度的采样频率一般较高，用以实现高带宽内环；

步骤(2)：由于快反镜系统是一个线性系统，通过频率响应测试仪可对平台的加速度频率对象特性进行测试，输入为控制器输出值，输出为加速度计采样值。高采样率可获得较高精度的加速度对象模型G_a(s)，用于实现高带宽加速度环；

步骤(3)：在获取到对象模型G_a(s)基础上，设计加速度控制器C_a(s)实现加速度闭环，然后设计速度控制器C_v(s)实现速度反馈闭环，最后利用图像传感器CCD实现位置控制器C_p(s)和位置闭环，这样就实现了传统的三环闭环控制；在各控制器设计过程中，考虑到加速度对象模型中的二次微分环节，为了避免加速度控制器中出现的二次积分而导致系统饱和，加速度控制器C_a(s)设计为滞后控制器，模型参考如下：

其中，K_a为控制器增益，T_e为加速度对象模型中滞后因子，T₁为滞后补偿因子。加速度闭环后，改善了被控对象特性，从而速度控制器C_v(s)和位置控制器C_p(s)可设计为PI控制器。；

步骤(4)：在加速环内添加扰动观测器是快反镜稳定平台的测量对象模型，是真实对象模型G_a(s)的近似。把加速度控制器的输出同时分别输入给G_a(s)和这样利用两者的输出量做差，可观测出扰动角加速度量；

步骤(5)：设计前馈补偿控制器C_f(s)，把观测出的扰动角加速度量转换为控制器输出量来进行前馈补偿，从而实现对扰动加速度，也就是扰动力矩的抵消。在设计前馈补偿控制器C_f(s)时，为了避免加速度计在低频时噪声过大，信噪比较低，从而导致系统输出饱和，前馈补偿控制器C_f(s)设计为如下带二阶滤波环节的控制器模型：

其中，K_f为前馈控制器增益，T_e为加速度对象模型中滞后因子，w_f为二阶滤波器滤波带宽因子，ξ_f二阶滤波器滤波阻尼因子。当前馈补偿器设计为如上模型后，整个扰动观测补偿器呈现一个超前滞后校正特性，从而实现扰动抑制能力的提升。

下面以一快反镜稳定平台实验系统为例对本发明的设计过程和效果进行详细说明：

(1)通过频率响应测试仪测出系统的加速度传递函数模型为，在设计过程中可认为G_a(s)和近似相等：

(2)通过加速度对象模型可以此设计出加速度、速度、位置控制器，其中加速度环控制器设计为：

(3)当实现三环闭环控制后，设计扰动观测补偿器为：

(4)如图2是本发明的稳定误差对比图。在相同扰动情况下，通过对比有无扰动观测补偿器的扰动抑制残差，可以明确看出扰动观测补偿器和三闭环控制方法的结合可以有力地提高系统扰动抑制能力，使残差大幅下降。

(5)如图3是本发明的整体抑制能力对比图。与传统三闭环控制方法相比，可以明确看出扰动观测补偿器可以有力地提高系统扰动抑制比。由于加速度计对低频扰动的不敏感性，从而导致扰动观测补偿在低频效果不明显。