[发明专利]一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法

说明书

一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法，它属于惯性技术领域。本发明解决了由于半球谐振陀螺X/Y通路驱动增益不对称引起驻波方位角漂移及控制回路误差的问题。本发明基于存在驱动增益不对称系数k时进动速度模型，使用非线性最小二乘法对误差参数进行辨识，从而计算出驱动增益不对称误差系数，进而解决驻波方位角漂移及控制回路存在误差的问题。本发明方法可以应用于对半球谐振陀螺X/Y通路驱动增益不对称性误差进行辨识。

技术领域

本发明属于惯性技术领域，具体涉及一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法。

背景技术

半球谐振陀螺技术是惯性领域一项变革性的颠覆技术，能够极大地提升导航与控制系统性能，对深空探测以及相关国民经济建设等方面将产生重大影响。半球谐振陀螺具有高精度，低噪声，大动态，长寿命，高可靠性等优势，是未来惯性仪表发展的主流趋势之一，尤其是面向高精度航天领域应用潜力巨大。半球谐振陀螺工作原理是当存在外界角度输入时谐振子振动驻波由于科氏力的作用产生进动，并且进动角度与输入角度成正比。通过X/Y两路信号实时检测驻波位置，可以测量出外界输入角度及角速度。但是由于两路驱动电路参数不匹配、加工制造误差、装配误差以及温度等环境因素对陀螺参数的影响，导致X/Y两路驱动信号增益不一致，进而引起驻波方位角漂移及控制回路误差等问题，降低陀螺性能。因此，提出一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法是非常有意义的。

发明内容

本发明的目的是为解决由于半球谐振陀螺X/Y通路驱动增益不对称引起驻波方位角漂移及控制回路误差的问题，而提出一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法。

本发明为解决上述技术问题所采取的技术方案是：

一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法，所述方法具体包括以下步骤：

步骤1、对半球谐振子进行参数激励，使得半球谐振子的振动幅值稳定；

步骤2、沿理想驻波波幅轴垂直方向施加恒定静电力使得驻波进动；

步骤3、采集与半球谐振子驻波进动相关的慢变量C_x、S_x、C_y和S_y，再对慢变量C_x、S_x、C_y和S_y进行二次组合，得到半球谐振陀螺控制系统变量E、Q、S和R；

并根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ω_r及振动幅值A；

步骤4、给定辨识参数初值k(0)＝1，H(0)＝0；

步骤5、根据解算出的驻波方位角θ、进动速度ω_r和振动幅值A以及辨识参数初值k(0)和H(0)计算初始时刻的值函数r(0)；

步骤6、计算值函数初始时刻的雅可比矩阵J_r(0)；

步骤7、根据雅可比矩阵J_r(0)计算辨识参数初始时刻的增量；

步骤8、根据步骤7中获得的增量计算下一时刻的辨识参数；

步骤9、利用步骤8计算出的下一时刻辨识参数(且下一次迭代时步骤5所利用的是上一次迭代过程中步骤8获得的辨识参数)重复执行步骤5至步骤8的过程，直至不再有控制系统变量输入时停止，并将最后一次迭代获得的驱动增益不对称系数作为输出。

进一步地，所述步骤3中，根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ω_r及振动幅值A，其具体过程为：