[发明专利]基于双俯仰轴稳台随动控制方法

权利要求书

1.一种基于双俯仰轴稳台随动控制方法，其特征在于，步骤如下：

1)通过测角传感器与测速传感器获取双俯仰轴稳台两侧负载的旋转角度信号与旋转角速度信号；

2)利用高精度倾角仪对双俯仰轴稳台两侧进行角度基准校准，并利用最小二乘法进行补偿修正；

3)令双俯仰轴稳台的一侧旋转部分为主随动系统，双俯仰轴稳台的另一侧旋转部分为副随动系统，给主随动系统输入一个速度设定值r1(k),主随动系统通过速度闭环反馈来控制其按照输入速度值进行转动，同时将测角传感器的值传递給副随动系统，副随动系统通过位置闭环反馈与速度闭环反馈来控制其与主随动系统同步随动。

2.根据权利要求1所述的基于双俯仰轴稳台随动控制方法，其特征在于：所述步骤1中，测角传感器在安装过程中要求其旋转轴与电机的旋转轴同轴，测角传感器的采样周期小于10ms。

3.根据权利要求1所述的基于双俯仰轴稳台随动控制方法，其特征在于：测速传感器在安装过程中要求其旋转轴与电机的旋转轴平行，测速传感器旋转轴与电机旋转轴同轴，测速传感器的采样周期小于3ms。

4.根据权利要求1所述的基于双俯仰轴稳台随动控制方法，其特征在于：实现所述步骤2的流程如下：

A.将双俯仰轴稳台固定在水平面上；

B.在双俯仰轴稳台两侧的基准面上分别安装倾角传感器；

C.调整双俯仰轴稳台两侧，使得两侧倾角传感器的值相等，此时记录双俯仰轴稳台主随动系统测角传感器的值angle_right[0],再记录双俯仰轴稳台副随动系统测角传感器的值angle_left[0]；

D.重复步骤C，N次从而得到两个数组angle_right[N]与angle_left[N]，N大于等于10；

E.令拟合直线方程y＝angle_left[i]＝a*angle_right[i]+b，利用最小二乘法进行解算拟合直线方程，解得系数a、系数b的值；

F.通过上一个步骤解得拟合直线方程为y＝a*x+b,其中x为主随动系统旋转角度，y为副随动系统旋转角度，将这个拟合直线方程做为副随动系统的前馈校正。