[发明专利]一种控制力矩陀螺框架伺服系统低转速高精度控制方法

摘要

本发明涉及一种控制力矩陀螺框架伺服系统低转速高精度控制方法。该方法针对控制力矩陀螺框架伺服系统在低速率工作过程中面临的摩擦干扰以及转子不平衡振动引起的扰动力矩问题，首先，建立含有摩擦干扰以及转子不平衡振动干扰力矩的控制力矩陀螺框架伺服系统动力学模型；其次，利用矢量控制与PI控制方法对框架伺服系统电流环进行控制设计；再次，设计干扰观测器在框架伺服系统速度环对摩擦干扰以及转子不平衡振动引起的扰动力矩组成的等价干扰进行估计；最后，将干扰观测器对等价干扰估计值通过前馈通道予以抵消，设计复合控制器，构造出一种控制力矩陀螺框架伺服系统低转速高精度控制方法。本发明具有工程实用性强、抗干扰性高等优点。

主权项

1.一种控制力矩陀螺框架伺服系统低转速高精度控制方法，其特征在于：包括以下步骤：第一步，建立含有摩擦干扰以及转子不平衡振动干扰力矩的控制力矩陀螺框架伺服系统的动力学模型；第二步，利用矢量控制与PI控制方法对控制力矩陀螺框架伺服系统电流环进行控制；第三步，在控制力矩陀螺框架伺服系统的速度环设计干扰观测器对控制力矩陀螺框架伺服系统受到的摩擦力矩与转子不平衡振动引起的扰动力矩组成的等价干扰进行估计；在控制力矩陀螺框架伺服系统的速度环设计干扰观测器对系统受到的摩擦力矩与转子不平衡振动引起的扰动力矩组成的等价干扰进行估计；根据系统模型获得框架伺服系统动力学方程为：其中，J为转子惯量与框架转动惯量之和；为电机转矩系数；为框架伺服系统转速对时间的一阶导数；i为框架伺服系统电流环输出电流；T_f为摩擦干扰力矩以及转子不平衡振动引起扰动力矩组成的总干扰力矩；从而依据上述动力学方程设计干扰观测器，对总干扰力矩Tf进行估计：其中，ω为框架伺服系统输出角速度；m为测量噪声；为控制力矩陀螺框架伺服系统速度环的开环传递函数；G_n(s)为框架伺服系统速度环的名义模型；为干扰观测器中的低通滤波器，0＜τ＜1为滤波器系数；为摩擦干扰力矩以及转子不平衡振动组成的总干扰力矩的估计值；第四步，将第三步中观测到的等价干扰估计值通过前馈通道予以抵消，并与PI控制器进行复合，构造出一种控制力矩陀螺框架伺服系统低转速高精度控制方法。