一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法技术

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

【技术实现步骤摘要】
一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法


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

技术介绍

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

技术实现思路

[0003]本专利技术的目的是为解决由于半球谐振陀螺X/Y通路驱动增益不对称引起驻波方位角漂移及控制回路误差的问题，而提出一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法。
[0004]本专利技术为解决上述技术问题所采取的技术方案是：
[0005]一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法，所述方法具体包括以下步骤：
[0006]步骤1、对半球谐振子进行参数激励，使得半球谐振子的振动幅值稳定；
[0007]步骤2、沿理想驻波波幅轴垂直方向施加恒定静电力使得驻波进动；
[0008]步骤3、采集与半球谐振子驻波进动相关的慢变量C
x
、S
x
、C
y
和S
y
，再对慢变量C
x
、S
x
、C
y
和S
y
进行二次组合，得到半球谐振陀螺控制系统变量E、Q、S和R；
[0009][0010]并根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ω
r
及振动幅值A；
[0011]步骤4、给定辨识参数初值k(0)＝1，H(0)＝0；
[0012]步骤5、根据解算出的驻波方位角θ、进动速度ω
r
和振动幅值A以及辨识参数初值k(0)和H(0)计算初始时刻的值函数r(0)；
[0013]步骤6、计算值函数初始时刻的雅可比矩阵J
r
(0)；
[0014]步骤7、根据雅可比矩阵J
r
(0)计算辨识参数初始时刻的增量；
[0015]步骤8、根据步骤7中获得的增量计算下一时刻的辨识参数；
[0016]步骤9、利用步骤8计算出的下一时刻辨识参数(且下一次迭代时步骤5所利用的是上一次迭代过程中步骤8获得的辨识参数)重复执行步骤5至步骤8的过程，直至不再有控制系统变量输入时停止，并将最后一次迭代获得的驱动增益不对称系数作为输出。
[0017]进一步地，所述步骤3中，根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ω
r
及振动幅值A，其具体过程为：
[0018][0019][0020]施加在x、y轴电极上的驱动驻波进动静电力的参数方程为：
[0021][0022]其中，F
x
为施加在x轴电极上的驱动驻波进动静电力，F
y
为施加在y轴电极上的驱动驻波进动静电力，k
x
、k
y
分别为x、y轴驱动电路增益系数，G为谐振子运动学模型，ω0为给定进动转速；
[0023]则进动速度ω
r
为：
[0024][0025]进一步地，所述步骤5的具体过程为：
[0026]根据P＝Aω
r
建立理论模型：
[0027][0028]其中，k为驱动增益不对称系数，中间变量H＝k0Gω0，k0为理想x、y轴驱动电路增益系数；
[0029]则值函数r(i)为：
[0030]r(i)＝P
d
(i)
‑
P
r
(i)
[0031]其中，P
d
(i)为i时刻采集信号处理后的实际检测值，P
r
(i)为i时刻根据理论模型的计算值；
[0032]根据建立的理论模型、给定的辨识初值以及值函数计算出初始时刻的值函数r(0)。
[0033]进一步地，所述步骤6的具体过程为：
[0034][0035]进一步地，所述步骤7的具体过程为：
[0036][0037]其中，上角标T代表矩阵的转置，上角标
‑
1代表矩阵的逆，Δk(0)代表k在初始时刻的增量，ΔH(0)代表H在初始时刻的增量。
[0038]更进一步地，所述步骤8的具体过程为：
[0039][0040]其中，k(1)和H(1)代表初始时刻的下一时刻的辨识参数。
[0041]本专利技术的有益效果是：本专利技术提出了一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法，本专利技术方法基于存在驱动增益不对称系数k时进动速度模型，使用非线性最小二乘法对误差参数进行辨识，从而计算出驱动增益不对称误差系数。进而解决驻波方位角漂移及控制回路存在误差的问题。
附图说明
[0042]图1为本专利技术方法的流程图；
[0043]图2为仿真结果图。
具体实施方式
[0044]具体实施方式一：结合图1说明本实施方式。本实施方式的一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法，该方法的具体过程为：
[0045]步骤1，对半球谐振子进行参数激励，使得谐振子的振动幅值稳定；
[0046]步骤2，沿理想驻波波幅轴垂直方向施加恒定静电力使驻波进动；
[0047]步骤3，采集与谐振子驻波振动相关参量C
x
、S
x
、C
y
、S
y
再进行二次组合，得到E、Q、S、R信号，解算驻波方位角θ、进动速度ω
r
及振动幅值A：
[0048][0049][0050][0051]步骤4，给定辨识初值通常电极增益偏差值小于10％、H在进动过程中为不变量。故取
[0052]H＝k0Gω0[0053][0054]其中，G为谐振子运动学模型，k0为理想x、y轴驱动电路增益系数，ω0为给定进动转速，k
x
、k
y
分别为x、y轴驱动电路增益系数，k为驱动增益不对称系数；
[0055]步骤5，计算当前时刻值函数：
[0056]当驻波波幅轴与x轴电极夹角为θ时，驱动驻波进动静电力的参数方程为：
[0057][0058]其中，F
x本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种半球谐振陀螺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的过程，直至不再有控制系统变量输入时停止，并将最后一次迭代获得的驱动增益不对称系数作为输出。2.根据权利要求1所述的一种半球谐振陀螺X/Y通路驱动增益不对称性误差辨识方法，其特征在于，所述步骤3中，根据控制系统变量E、Q、S和R解算出驻波方位角θ、进动速度ω
r
及振动幅值A，其具体过程为：及振动幅值A，其具体过程为：施加在x、y轴电极上的驱动驻...

【专利技术属性】
技术研发人员：解伟男，王奇，奚伯齐，孙一为，伊国兴，王常虹，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：