CN115077564A - 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 - Google Patents
一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 Download PDFInfo
- Publication number
- CN115077564A CN115077564A CN202210679577.4A CN202210679577A CN115077564A CN 115077564 A CN115077564 A CN 115077564A CN 202210679577 A CN202210679577 A CN 202210679577A CN 115077564 A CN115077564 A CN 115077564A
- Authority
- CN
- China
- Prior art keywords
- channel
- error
- detection
- rate
- signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 307
- 238000000034 method Methods 0.000 title claims abstract description 58
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 6
- 230000010354 integration Effects 0.000 claims description 34
- 238000012545 processing Methods 0.000 claims description 17
- 238000005070 sampling Methods 0.000 claims description 13
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 238000009795 derivation Methods 0.000 claims description 6
- 238000012549 training Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 abstract description 16
- 230000008878 coupling Effects 0.000 description 14
- 238000010168 coupling process Methods 0.000 description 14
- 238000005859 coupling reaction Methods 0.000 description 14
- 239000000306 component Substances 0.000 description 11
- 239000003990 capacitor Substances 0.000 description 10
- 238000009434 installation Methods 0.000 description 10
- 230000008054 signal transmission Effects 0.000 description 9
- 238000006073 displacement reaction Methods 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 239000000203 mixture Substances 0.000 description 2
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N Silicium dioxide Chemical compound O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 description 1
- 230000003321 amplification Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 239000005350 fused silica glass Substances 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,具体涉及一种速率积分半球谐振陀螺检测通道的不平衡误差的辨识及补偿方法,本发明为解决由于速率积分半球谐振陀螺检测通道的电压信号有偏差,使检测通道存在不平衡误差,导致速率积分半球谐振陀螺测量及控制精度不准确的问题,获取自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号;根据误差平方和最小原则利用离散电压包络信号建立目标函数;利用目标函数辨识速率积分半球谐振陀螺检测通道的不平衡误差;利用不平衡误差建立检测电压误差补偿公式,根据检测电压误差补偿公式利用前馈增益补偿控制器或数字控制器补偿算法对所述不平衡误差进行补偿,校验所述补偿。
Description
技术领域
本发明涉及一种陀螺误差辨识及补偿方法,具体涉及一种速率积分半球谐振陀螺检测通道的不平衡误差的辨识及补偿方法,属于陀螺误差领域。
背景技术
速率积分半球谐振陀螺通过谐振子振型的方位角来表征输入角度,并通过角增量表征输入角速率,它的核心部件由高品质因数熔融石英材质的半球谐振子及平板电极通过特定的焊接工艺相连,同时,专用的电容检测电路可以将谐振子唇沿与平板电极相对电容的变化转化为电压信号,并将信号进行放大。速率积分半球谐振陀螺检测通道主要由相差45°的两组平板电极与谐振子唇沿构成的等效平板电容及配套专用电容检测电路构成,通过解算两组电压信号以达到速率积分半球谐振陀螺角位置信息和角速率信息测量的目的,两组电压信号会受陀螺装配精度、电路元器件精度及检测信号传输线空间电磁耦合的影响,引入陀螺检测通道不平衡误差,使速率积分半球谐振陀螺检测通道的电压信号存在偏差,从而产生陀螺测量误差,并进一步将误差带入到速率积分半球谐振陀螺的控制回路中,导致速率积分半球谐振陀螺测量及控制精度均受到一定程度的影响,因此,速率积分半球谐振陀螺检测通道的一致性对速率积分半球谐振陀螺测量精度至关重要。
发明内容
本发明为了解决由于速率积分半球谐振陀螺检测通道的电压信号有偏差,使检测通道存在不平衡误差,导致速率积分半球谐振陀螺测量及控制精度不准确的问题,进而提出了一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法。
本发明采取的技术方案是:
它包括以下步骤:
S1、获取自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号;
S2、根据误差平方和最小原则利用所述离散电压包络信号建立离散电压包络信号目标函数;
S3、利用离散电压包络信号目标函数辨识速率积分半球谐振陀螺检测通道的不平衡误差,得到检测通道的不平衡误差结果,完成检测通道的不平衡误差辨识;
S4、利用得到的所述不平衡误差结果建立检测电压误差补偿公式,根据检测电压误差补偿公式利用前馈增益补偿控制器或数字控制器补偿算法对所述不平衡误差进行补偿,完成检测通道的不平衡误差补偿;
S5、对检测通道的不平衡误差补偿进行校验。
优选的,所述S1中速率积分半球谐振陀螺检测通道包括X通道和Y通道。
优选的,所述S1中获取自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号,具体过程为:
S11、将速率积分半球谐振陀螺安装在速率转台的台面上,速率积分半球谐振陀螺的敏感轴与转台的回转轴平行,给定速率转台的角速度,将速率积分半球谐振陀螺处于高速旋转状态,并将速率积分半球谐振陀螺设置为自由振动状态,获取自由振动和高速旋转状态下的速率积分半球谐振陀螺X通道的电压信号和Y通道的电压信号:
其中,Uxd表示速率积分半球谐振陀螺在自由振动和高速旋转状态下X通道的电压信号;
Uyd表示速率积分半球谐振陀螺在自由振动和高速旋转状态下Y通道的电压信号;
Gx表示X通道存在不平衡误差时的信号增益;
Gy表示Y通道存在不平衡误差时的信号增益;
G表示专用电容检测电路的电容-电压转换增益;
a表示半球谐振子主驻波振幅;
kg表示速率积分半球谐振陀螺驻波进动系数;
Ω表示速率积分半球谐振陀螺外界输入角速率;
t表示系统工作时间;
2θ0表示半球谐振子驻波初始方位角;
δθ表示速率积分半球谐振陀螺检测通道的等效电极偏角;
ω表示半球谐振子基础振动频率;
e表示自然常数;
τ表示半球谐振子平均机械振动时间常数;
S12、对所述X通道的电压信号进行平方,得到平方后的X通道的电压信号;
对所述Y通道的电压信号进行平方,得到平方后的Y通道的电压信号;
S13、利用低通滤波器对平方后的X通道的电压信号进行处理,得到X通道的电压包络信号;
利用低通滤波器对平方后的Y通道的电压信号进行处理,得到Y通道的电压包络信号;
S14、对X通道的电压包络信号进行离散处理,得到X通道的离散电压包络信号;
对Y通道的电压包络信号进行离散处理,得到Y通道的离散电压包络信号;
其中,Vxd_z(kN)表示X通道的离散系统采样点kN的离散电压包络信号;
Vyd_z(kN)表示Y通道的离散系统采样点kN的离散电压包络信号;
Axd表示X通道检测信号的最大幅度,Axd=GxGa;
Ayd表示Y通道检测信号的最大幅度,Ayd=GyGa;
Te表示离散系统采样周期;
θxd表示存在等效电极偏角误差的X通道的检测电极方位角;
θyd表示存在等效电极偏角误差的Y通道的检测电极方位角;
NS(kN)表示零均值干扰及噪声的集合;
S15、对X通道的离散电压包络信号进行数据拟合,得到拟合后的X通道的离散电压包络信号;
对Y通道的离散电压包络信号进行数据拟合,得到拟合后的Y通道的离散电压包络信号;
优选的,所述S2中根据误差平方和最小原则利用所述离散电压包络信号建立离散电压包络信号目标函数,具体过程为:
根据误差平方和最小原则利用S14中得到的X通道的离散电压包络信号和S15得到的拟合后的X通道的离散电压包络信号建立X通道的离散电压包络信号目标函数;
根据误差平方和最小原则利用S14中得到的Y通道的离散电压包络信号和S15得到的拟合后的Y通道的离散电压包络信号建立Y通道的离散电压包络信号目标函数;
其中,Jx表示X通道的离散电压包络信号目标函数;
Jy表示Y通道的离散电压包络信号目标函数;
N表示离散系统采样点的总数;
当X通道的离散电压包络信号目标函数和Y通道的离散电压包络信号均取最小值时,得到X通道的检测信号幅值最优估计结果、Y通道的检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果、Y通道的检测电极等效方位角最优估计结果、速率积分半球谐振陀螺进动系数最优估计结果、半球谐振子平均机械振动时间常数的最优估计结果。
优选的,所述S3中检测通道的不平衡误差结果包括等效电极偏角误差和不平衡增益误差。
优选的,所述S3中利用离散电压包络信号目标函数辨识速率积分半球谐振陀螺检测通道的不平衡误差,得到检测通道的不平衡误差结果,具体过程为:
S31、利用所述X通道的离散电压包络信号目标函数辨识拟合后的X通道的离散电压包络信号中检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果;
利用所述Y通道的离散电压包络信号目标函数辨识拟合后的Y通道的离散电压包络信号中检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果;
S32、根据辨识的X通道的检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果计算X通道的不平衡误差结果;
根据辨识的Y通道的检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果计算Y通道的不平衡误差结果;
优选的,所述S4中利用得到的所述不平衡误差结果建立检测电压误差补偿公式,具体过程为:
Ux_c(k-1)表示X通道第k-1次补偿后的检测电极信号;
Uy_c(k-1)表示Y通道第k-1次补偿后的检测电极信号;
优选的,所述S5中对检测通道的不平衡误差补偿进行校验,具体过程为:
S51、建立陀螺角速率-陀螺检测通道不平衡误差模型,对陀螺角速率-陀螺检测通道不平衡误差模型进行训练,输入检测通道的不平衡误差结果,输出速率积分半球谐振陀螺的角速率,得到训练好的陀螺角速率-陀螺检测通道不平衡误差模型,具体过程为:
S511、获取速率积分半球谐振陀螺仅包含半球谐振子驻波方位角和振幅信息的X通道的电压信号和Y通道的电压信号:
其中,Ux_LPF表示仅包含半球谐振子驻波方位角及振幅信息的X通道理想电压信号;
Uy_LPF表示仅包含半球谐振子驻波方位角及振幅信息的Y通道理想电压信号;
2θ表示半球谐振子驻波理想方位角;
S512、根据S511得到的X通道的电压信号计算包含不平衡误差的X通道电压信号;
根据S511得到的Y通道的电压信号计算包含不平衡误差的Y通道电压信号;
S513、根据X通道电压信号和Y通道电压信号的相对关系得到包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角:
其中,2θd表示包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角;
S514、对包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角求导,并结合外界输入角速度和速率积分半球谐振陀螺进动系数,得到陀螺角速率-陀螺检测通道不平衡误差模型:
Ωd=Ω-(2δθΩsin4θ+δGxyΩcos4θ) (10)
其中,Ωd表示速率积分半球谐振陀螺输出角速率;
4θ表示半球谐振子振型方位角的二倍角;
S52、将S4中不平衡误差补偿后的速率积分半球谐振陀螺的状态设置为工作状态和高速旋转状态,执行S1-S3,得到所述速率积分半球谐振陀螺在工作状态和高速旋转状态下的检测通道的不平衡误差,判断所述不平衡误差是否满足速率积分半球谐振陀螺的精度要求,若满足速率积分半球谐振陀螺的精度要求,不平衡误差补偿成功;
否则,不平衡误差补偿失败,获取所述速率积分半球谐振陀螺的角位置信息,对角位置信息进行差分得到角速率信息,根据所述角位置信息和所述角速率信息绘制陀螺驻波角位置-时间曲线图和陀螺驻波角速率-时间曲线图,得到两条曲线间的相位关系,利用S514中陀螺角速率-陀螺检测通道不平衡误差模型根据两条曲线间的相位关系辨识所述速率积分半球谐振陀螺检测通道不平衡误差,不平衡误差包括等效电极偏角误差及不平衡增益误差,利用不平衡误差补偿值公式确定所述不平衡误差的补偿值,再根据S4中建立的检测电压误差补偿公式进行补偿。
优选的,所述S52中速率积分半球谐振陀螺的精度要求:
优选的,所述S52中不平衡误差补偿值公式:
当不平衡误差主要组成为等效电极偏角误差时,不平衡误差补偿值公式为:
若不平衡误差主要组成为不平衡增益误差时,不平衡误差补偿值公式为:
有益效果:
本发明利用自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号进行检测通道的不平衡误差辨识和补偿,对得到的离散电压包络信号根据误差平方和最小原则建立离散电压包络信号目标函数,根据目标函数辨识不平衡误差,得到不平衡误差结果,不平衡误差结果包括等效电极偏角误差和不平衡增益误差,从而完成速率积分半球谐振陀螺检测通道的不平衡误差辨识;利用得到的不平衡误差结果建立检测电压误差补偿公式,根据检测电压误差补偿公式利用前馈增益补偿控制器或数字控制器补偿算法对不平衡误差进行快速、精确补偿,得到补偿后的速率积分半球谐振陀螺,从而完成速率积分半球谐振陀螺检测通道的不平衡误差补偿,如此能够抑制或消除电极信号耦合、陀螺装配、电路元器件参数误差对速率积分半球谐振陀螺测量精度及控制精度的影响;最终对不平衡误差补偿进行校验,获取补偿后的速率积分半球谐振陀螺在工作状态和高速旋转状态下的检测通道的不平衡误差,判断不平衡误差补偿的效果是否可观,即判断所述不平衡误差是否满足速率积分半球谐振陀螺的精度要求,若满足速率积分半球谐振陀螺的精度要求,不平衡误差补偿成功;否则,不平衡误差补偿失败,获取所述速率积分半球谐振陀螺的角位置信息,对角位置信息进行差分得到角速率信息,根据所述角位置信息和所述角速率信息绘制陀螺驻波角位置-时间曲线图和陀螺驻波角速率-时间曲线图,得到两条曲线间的相位关系,利用训练好的陀螺角速率-陀螺检测通道不平衡误差模型根据两条曲线间的相位关系分析不平衡误差的主要组成(等效电极偏角误差和不平衡增益误差),针对每种误差利用不平衡误差补偿值公式确定补偿值,再利用检测电压误差补偿公式单独进行补偿,依次完成所有误差的补偿,从而降低两种误差补偿过程中的相互影响。通过依次对误差主成分进行补偿也使得补偿过程更具备针对性,更易达到补偿目标,提高补偿效率。直至满足速率积分半球谐振陀螺的精度要求。此时即可完成不平衡误差辨识和补偿。
本发明通过辨识和补偿检测通道的不平衡误差提高了速率积分半球谐振陀螺的角速率测量精度,能够有效解决速率积分半球谐振陀螺检测电极信号传输线空间电磁耦合、电路元器件参数误差及陀螺装配误差引起的检测通道不平衡误差,还能够简化电路元器件筛选流程,抑制检测电极信号传输线空间电磁耦合及速率积分半球谐振陀螺装配误差对速率积分半球谐振陀螺测量及控制精度的影响,从而有效提高速率积分半球谐振陀螺的测量及控制精度,使速率积分半球谐振陀螺的测量及控制精度更加准确,进一步提升了速率积分半球谐振陀螺的整体性能。
附图说明
图1是速率积分半球谐振陀螺振动位移信号的李萨如图;
图2是引入正交控制后速率积分半球谐振陀螺振动位移信号的李萨如图;
图3是速率积分半球谐振陀螺安装倾角误差示意图,图中β为半球谐振子安装倾角误差,d为半球谐振子唇沿与平板电极理想间距,d′为安装倾角误差引起的半球谐振子唇沿与平板电极间距误差;
图4是速率积分半球谐振陀螺检测通道不平衡误差来源图;
具体实施方式
具体实施方式一:结合图1-图4说明本实施方式,本实施方式所述一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,它包括以下步骤:
S1、获取自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号,具体过程为:
速率积分半球谐振陀螺利用谐振子唇沿与平板电极上相差45°的两组电极构成的等效平板电容器实现半球谐振子振动信号的测量。速率积分半球谐振陀螺检测通道主要由相差45°的两组平板电极与谐振子唇沿构成的等效平板电容及配套专用电容检测电路构成,即可得检测通道包括两个通道,且理想情况下两个通道检测信号的相位差为90°,因此可将速率积分半球谐振陀螺的两个检测通道定义为X通道和Y通道。通过解算X通道和Y通道的电压信号以达到速率积分半球谐振陀螺角位置信息和角速率信息测量的目的。本发明以自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的不平衡误差进行辨识和补偿,自由振动状态下排除了控制误差对陀螺的影响,高速旋转消除了陀螺的周向不均匀误差。
S11、将速率积分半球谐振陀螺安装在高精度速率转台的台面上,使速率积分半球谐振陀螺的敏感轴与转台的回转轴平行,给定高精度速率转台的角速度,将速率积分半球谐振陀螺处于高速旋转状态,并将速率积分半球谐振陀螺设置为自由振动状态,获取此时自由振动和高速旋转状态下的速率积分半球谐振陀螺X通道的电压信号和Y通道的电压信号:
其中,Uxd表示速率积分半球谐振陀螺在自由振动和高速旋转状态下X通道的电压信号;Uyd表示速率积分半球谐振陀螺在自由振动和高速旋转状态下Y通道的电压信号;Gx表示X通道存在不平衡误差时的信号增益;Gy表示Y通道存在不平衡误差时的信号增益;G表示专用电容检测电路的电容-电压转换增益;a表示半球谐振子主驻波振幅;kg表示速率积分半球谐振陀螺驻波进动系数;Ω表示速率积分半球谐振陀螺外界输入角速率;t表示系统工作时间;2θ0表示半球谐振子驻波初始方位角;δθ表示速率积分半球谐振陀螺检测通道的等效电极偏角;ω表示半球谐振子基础振动频率;e表示自然常数;τ表示半球谐振子平均机械振动时间常数。
S12、对所述X通道的电压信号进行平方,得到平方后的X通道的电压信号;
对所述Y通道的电压信号进行平方,得到平方后的Y通道的电压信号;
S13、利用低通滤波器对平方后的X通道的电压信号进行处理,得到X通道的电压包络信号;
利用低通滤波器对平方后的Y通道的电压信号进行处理,得到Y通道的电压包络信号;
电压包络信号中的关键参数理想情况下均为常值,而在实际情况中也为慢变量,低通滤波器用于去除电压包络信号中的中高频信号,是一种常规的信号处理手段,采用低通滤波器对包络信号中的关键参数并无影响,且能够提高下文中的辨识精度。
S14、利用模数转换芯片及数字控制电路对X通道的电压包络信号进行离散处理,得到X通道的离散电压包络信号;
利用模数转换芯片及数字控制电路对Y通道的电压包络信号进行离散处理,得到Y通道的离散电压包络信号:
其中,Vxd_z(kN)表示X通道的离散系统采样点kN的离散电压包络信号;Vyd_z(kN)表示Y通道的离散系统采样点kN的离散电压包络信号;Axd表示X通道检测信号的最大幅度,Axd=GxGa;Ayd表示Y通道检测信号的最大幅度,Ayd=GyGa;Te表示离散系统采样周期;θxd表示存在等效电极偏角误差的X通道的检测电极方位角;θyd表示存在等效电极偏角误差的Y通道的检测电极方位角;NS(kN)表示零均值干扰及噪声的集合。
S15、对X通道的离散电压包络信号进行数据拟合,得到X通道的离散电压包络信号模型,从而得到拟合后的X通道的离散电压包络信号;
对Y通道的离散电压包络信号进行数据拟合,得到Y通道的离散电压包络信号模型,从而得到拟合后的Y通道的离散电压包络信号;
离散电压包络信号模型为:
利用离散电压包络信号模型消除或减弱公式(2)中的零均值干扰及噪声,以得到更加准确的离散电压包络信号,提高后续计算的准确性。
拟合后的离散电压包络信号:
表示离散系统采样点kN拟合后的X通道的离散电压包络信号;表示离散系统采样点kN拟合后的Y通道的离散电压包络信号;表示X通道的检测信号幅值估计结果;表示Y通道的检测信号幅值估计结果;表示X通道的检测电极等效方位角估计结果;表示Y通道的检测电极等效方位角估计结果;表示速率积分半球谐振陀螺进动系数估计结果;表示半球谐振子平均机械振动时间常数的估计结果。
S2、根据误差平方和最小原则利用所述离散电压包络信号建立离散电压包络信号目标函数,具体过程为:
根据误差平方和最小原则利用S14中得到的X通道的离散电压包络信号和S15得到的拟合后的X通道的离散电压包络信号建立X通道的离散电压包络信号目标函数;
根据误差平方和最小原则利用S14中得到的Y通道的离散电压包络信号和S15得到的拟合后的Y通道的离散电压包络信号建立Y通道的离散电压包络信号目标函数;
其中,Jx表示X通道的离散电压包络信号目标函数;Jy表示Y通道的离散电压包络信号目标函数;N表示离散系统采样点的总数。
当X通道的离散电压包络信号目标函数Jx和Y通道的离散电压包络信号Jy均取得最小值时,得到X通道的检测信号幅值最优估计结果Y通道的检测信号幅值最优估计结果X通道的检测电极等效方位角最优估计结果Y通道的检测电极等效方位角最优估计结果速率积分半球谐振陀螺进动系数最优估计结果半球谐振子平均机械振动时间常数的最优估计结果
S3、利用离散电压包络信号目标函数辨识速率积分半球谐振陀螺检测通道的不平衡误差,得到检测通道的不平衡误差结果,完成检测通道的不平衡误差辨识,具体过程为:
所述S3中检测通道的不平衡误差结果包括等效电极偏角误差和不平衡增益误差。
S31、利用所述X通道的离散电压包络信号目标函数辨识拟合后的X通道的离散电压包络信号中检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果;
利用所述Y通道的离散电压包络信号目标函数辨识拟合后的Y通道的离散电压包络信号中检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果;
S32、根据辨识的X通道的检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果计算X通道的不平衡误差结果;
根据辨识的Y通道的检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果计算Y通道的不平衡误差结果;
S4、利用得到的所述不平衡误差结果建立检测电压误差补偿公式,根据检测电压误差补偿公式利用前馈增益补偿控制器或数字控制器补偿算法对所述不平衡误差进行补偿,完成检测通道的不平衡误差补偿,具体过程为:
不平衡误差结果建立检测电压误差补偿公式:
其中,Ux_c(k)表示X通道第k次补偿后的检测电极信号, 表示包含X通道不平衡误差的X通道电压信号;Ux_c(k-1)表示X通道第k-1次补偿后的检测电极信号;Uy_c(k)表示Y通道第k次补偿后的检测电极信号, 表示包含Y通道不平衡误差的Y通道电压信号;Uy_c(k-1)表示Y通道第k-1次补偿后的检测电极信号;表示第k次辨识的检测通道不平衡增益误差;表示第k次辨识的检测通道等效电极偏角误差。
根据检测电压误差补偿公式通过在检测通道串联前馈补偿环节或在数字控制器解算方法中增加数值补偿程序,对不平衡误差进行补偿,完成检测通道的不平衡误差补偿。
S5、对检测通道的不平衡误差补偿进行校验,具体过程为:
S51、根据速率积分半球谐振陀螺加工工艺及硬件电路特性建立陀螺角速率-陀螺检测通道不平衡误差模型,对陀螺角速率-陀螺检测通道不平衡误差模型进行训练,输入检测通道的不平衡误差结果,输出速率积分半球谐振陀螺的角速率,得到训练好的陀螺角速率-陀螺检测通道不平衡误差模型,具体过程为:
S511、根据速率积分半球谐振陀螺特性获取理想情况下速率积分半球谐振陀螺仅包含半球谐振子驻波方位角和振幅信息的X通道的电压信号和Y通道的电压信号:
其中,Ux_LPF表示仅包含半球谐振子驻波方位角及振幅信息的X通道理想电压信号;Uy_LPF表示仅包含半球谐振子驻波方位角及振幅信息的Y通道理想电压信号;2θ表示半球谐振子驻波理想方位角。
S512、根据S511得到的X通道的电压信号结合速率积分半球谐振陀螺加工工艺及硬件电路特性计算包含不平衡误差的X通道电压信号;
根据S511得到的Y通道的电压信号结合速率积分半球谐振陀螺加工工艺及硬件电路特性计算包含不平衡误差的Y通道电压信号;
S513、根据X通道电压信号和Y通道电压信号的相对关系,得到包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角:
S514、对包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角求导,并结合外界输入角速度和速率积分半球谐振陀螺进动系数,得到陀螺角速率-陀螺检测通道不平衡误差模型:
Ωd=Ω-(2δθΩsin4θ+δGxyΩcos4θ) (10)
其中,Ωd表示速率积分半球谐振陀螺输出角速率;4θ表示半球谐振子振型方位角的二倍角。
S52、将S4中不平衡误差补偿后的速率积分半球谐振陀螺的状态设置为工作状态和高速旋转状态,执行S1-S3,得到所述速率积分半球谐振陀螺在工作状态和高速旋转状态下的检测通道的不平衡误差,判断所述不平衡误差是否满足速率积分半球谐振陀螺的精度要求,若满足速率积分半球谐振陀螺的精度要求,不平衡误差补偿成功;
否则,不平衡误差补偿失败,根据现有方法获取所述速率积分半球谐振陀螺的角位置信息,对角位置信息进行差分得到角速率信息,根据所述角位置信息和所述角速率信息绘制陀螺驻波角位置-时间曲线图和陀螺驻波角速率-时间曲线图,得到两条曲线间的相位关系,利用S514中陀螺角速率-陀螺检测通道不平衡误差模型根据两条曲线间的相位关系辨识所述速率积分半球谐振陀螺检测通道不平衡误差,不平衡误差包括等效电极偏角误差及不平衡增益误差,利用不平衡误差补偿值公式确定所述不平衡误差的补偿值,再根据S4中建立的检测电压误差补偿公式进行补偿。
所述速率积分半球谐振陀螺的精度要求:
所述不平衡误差补偿值公式:
当不平衡误差主要组成为等效电极偏角误差时,不平衡误差补偿值公式为:
若不平衡误差主要组成为不平衡增益误差时,不平衡误差补偿值公式为:
实施例
1、分析速率积分半球谐振陀螺检测通道不平衡误差来源:
速率积分半球谐振陀螺(简称陀螺)检测通道不平衡误差主要由检测信号传输线空间电磁耦合、陀螺装配误差及电路元器件参数误差引起,且引起的检测信号传输线空间电磁耦合误差、电路元器件参数误差及陀螺装配误差无法避免。对于速率积分半球谐振陀螺,由于其驻波处于自由或受控进动状态,因此检测通道不平衡误差对振型方位角及角速率检测精度的影响难以忽视,同时,检测通道不平衡误差还将进一步对陀螺幅度控制回路、正交控制回路精度产生影响。
速率积分半球谐振陀螺利用谐振子唇沿与平板电极上相差45°的两组电极构成的等效平板电容器实现半球谐振子振动信息的测量。速率积分半球谐振陀螺检测通道主要由相差45°的两组平板电极与谐振子唇沿构成的等效平板电容及配套专用电容检测电路构成,通过解算两组电压信号以达到速率积分半球谐振陀螺角位置信息和角速率信息测量的目的,即可得检测通道包括两个通道,则定义所述速率积分半球谐振陀螺的检测通道包括X通道和Y通道,通过解算X通道和Y通道的电压信号即可得到速率积分半球谐振陀螺的角位置或角速率输出。一般情况下,X通道和Y通道的振动位移信号为:
其中,x表示X通道的振动位移信号;y表示Y通道的位移信号;a表示半球谐振子主驻波振幅;2θ表示半球谐振子驻波理想方位角;ω表示半球谐振子基础振动频率;t表示系统工作时间;φ表示速率积分半球谐振陀螺初始振动时间相位;q表示正交波振幅。此时,根据公式(1)得到对应的李萨如图,如图1所示。
为了提升速率积分半球谐振陀螺的测量精度,在实际的陀螺控制中引入正交控制回路,将半球谐振子正交波波幅控制到0,即q=0,此时陀螺X通道和Y通道的振动位移信号x′和y′为:
根据公式(2)得到李萨如图,如图2所示。此时,利用专用电容检测电路将半球谐振子X通道和Y通道的振动位移信号引起的电容变化转换为电压检测信号:
式中,Ux表示速率积分半球谐振陀螺X通道检测电极理想电压信号;Uy表示速率积分半球谐振陀螺Y通道检测电极理想电压信号;G表示专用电容检测电路的电容-电压转换增益。将公式(3)通过低通滤波器得到仅包含半球谐振子驻波方位角及振幅信息的检测通道电压公式:
式中,Ux_LPF表示仅包含半球谐振子驻波方位角及振幅信息的X通道理想电压信号;Uy_LPF表示仅包含半球谐振子驻波方位角及振幅信息的Y通道理想电压信号。
1.1针对误差来源“检测信号传输线空间电磁耦合”分析对陀螺检测信号的影响:
速率积分半球谐振陀螺采用两件式平板电极结构,通过中心角相差45°的检测电极处的电压变化反映半球谐振子的振动位移,理想情况下,X通道和Y通道检测信号方位正交(如式(4)所示),但是实际测量过程中,各通道信号传输线间存在空间电磁耦合现象,从而导致检测信号受到影响,此时陀螺X通道和Y通道电压检测信号为:
为了更好的描述检测信号传输线间空间电磁耦合现象对陀螺电压检测信号的影响,引入等效电极偏角描述检测电极间的耦合系数,即η=tanδθ,则有:
其中,δθ表示速率积分半球谐振陀螺检测通道的等效电极偏角。
由式(6)可知,陀螺X通道和Y通道检测电极间的耦合现象导致陀螺检测信号的幅度和正交性均发生了变化,但两通道检测信号的相对幅度未发生变化。
1.2、针对误差来源“陀螺装配误差”分析对陀螺检测信号的影响:
陀螺装配误差主要指半球谐振子装配倾角误差。在理想状态下,半球谐振子与平板电极相互垂直,此时半球谐振子唇沿与平板电极间距相同。但是,在实际加工过程中,受到半球谐振子装配工艺的限制,在半球谐振子与电极基板装配完成后,存在安装倾角误差,导致检测电极与半球谐振子间距离仍呈现一次谐波分布,这将导致陀螺X通道和Y通道检测信号增益不平衡。速率积分半球谐振陀螺半球谐振子装配倾角误差示意图如图3所示。
陀螺安装倾角误差导致X通道和Y通道的静态检测电容值发生变化:
其中,Cx表示存在陀螺安装倾角误差时的X通道的静态检测电容值;Cy表示存在陀螺安装倾角误差时的Y通道的静态检测电容值;S表示半球谐振子唇沿与平板电极等效正对面积;d为半球谐振子唇沿与平板电极理想间距;π表示圆周率;k表示静电常数,取值为k=9.0×109N·m2/C2;dx表示安装倾角误差引起的X通道等效平板电容间距误差,dx=βRcosθd,β表示半球谐振子安装倾角误差,R表示半球谐振子半径,θd表示半球谐振子装配倾角方位角;dy表示安装倾角误差引起的Y通道等效平板电容间距误差,
利用专用电容检测电路将上述的电容变化转换为电压信号,转换后电压信号与静态检测电容值成反比。由陀螺装配倾角误差引起的X通道和Y通道检测增益误差Gcx和Gcy的关系为:
Gcx=(1+δGcxy)Gcy (8)
1.3、针对误差来源“电路元器件参数误差”分析对陀螺检测信号的影响:
受电路分布参数以及线性放大元件参数的不一致性影响,谐振子振动检测信号缓冲电路产生了信号增益差异。受电路分布参数及基准电压、时钟源漂移影响,谐振子振动检测信号模数转换通道产生了信号采样增益误差。假设由电路参数引起的X通道和Y通道的检测信号增益分别为Gax和Gay,则有:
Gax=(1+δGaxy)Gay (9)
式中,δGaxy为由电路参数引起的X通道和Y通道检测增益不平衡误差。
当速率积分半球谐振陀螺检测通道中存在上述检测增益不平衡误差时X通道和Y通道的检测信号增益分别为Gx和Gy,此时陀螺检测通道不平衡增益误差δGxy为:
1.4、针对检测通道不平衡增益分析对陀螺输出角位置及角速度的影响:
根据上述计算得,速率积分半球谐振陀螺检测通道不平衡误差来源如图4所示。
通过X通道电压检测信号和Y通道电压检测信号的相对关系,解算得到包含检测通道不平衡误差的驻波方位角2θd:
式中,表示求导后的包含检测通道不平衡误差的半球谐振子驻波方位角;表示求导后的理想半球谐振子振型方位角;表示求导后的半球谐振子驻波方位角检测误差;kg为速率积分半球谐振陀螺驻波进动系数,Ω为速率积分半球谐振陀螺外界输入角速率,4θ表示半球谐振子振型方位角的二倍角。则速率积分半球谐振陀螺输出角速率Ωd为:
由式(14)可知,速率积分半球谐振陀螺检测通道不平衡误差主要体现在不平衡增益误差及等效电极偏角两方面,即速率积分半球谐振陀螺输出角速率主要受不平衡增益误差及等效电极偏角的影响导致速率积分半球谐振陀螺检测通道存在不平衡误差。陀螺检测通道不平衡误差直接决定谐振子振型方位角及角速率检测精度,同时,在进行驻波幅度、正交控制时,陀螺控制量需按照计算得到的方位角进行分配,当存在检测通道不平衡误差时,解算得到的方位角也存在误差,在进行陀螺控制量分配时,也会产生相应的驱动误差,将进一步导致谐振子振型驻波方位角发生漂移,从而影响速率积分半球谐振陀螺的整体性能。
2、辨识不平衡误差:
为有效实现陀螺检测通道不平衡误差补偿,提高驻波方位角激励及检测精度,首先要解决陀螺检测通道不平衡误差的辨识问题。速率积分半球谐振陀螺检测通道不平衡误差由多种误差源组合得到,各部分误差不易通过独立辨识得到,故对陀螺检测通道不平衡误差进行整体辨识。
速率积分半球谐振陀螺检测通道不平衡增益误差可通过对自由振动状态的谐振子驻波在X通道检测电极及Y通道检测电极形成的周期性摆动电压信号进行辨识。
令内部半球谐振子处于自由振动状态的速率积分半球谐振陀螺围绕其敏感轴高速旋转,此时自由振动和高速旋转状态下的速率积分陀螺X通道的电压信号Uxd和Y通道的电压信号Uyd为:
式中,e表示自然常数;τ表示半球谐振子平均机械振动时间常数;2θ0表示半球谐振子驻波初始方位角。
将上述电压信号平方后经低通滤波器得到X通道的电压包络信号Vxd和Y通道的电压包络信号Vyd:
其中,lpf{}表示低通滤波函数;
式中,kN表示离散系统采样点;Axd和Ayd分别表示X通道和Y通道检测信号的最大幅度,即Axd=GxGa、Ayd=GyGa;Te表示离散系统采样周期,NS(kN)表示零均值干扰及噪声的集合。
S15、对X通道的离散电压包络信号进行数据拟合,得到X通道的离散电压包络信号模型;对Y通道的离散电压包络信号进行数据拟合,得到Y通道的离散电压包络信号模型;
离散电压包络信号模型的输出为拟合后的离散电压包络信号:
表示离散系统采样点kN拟合后的X通道的离散电压包络信号;表示离散系统采样点kN拟合后的Y通道的离散电压包络信号;和表示X通道和Y通道的检测信号幅值估计结果;和表示X通道和Y通道的检测电极等效方位角估计结果;表示陀螺进动系数估计结果;表示机械振动时间常数的估计结果。
根据误差平方和最小原则利用S14中得到的X通道的离散电压包络信号和S15得到的拟合后的X通道的离散电压包络信号建立X通道的离散电压包络信号目标函数;根据误差平方和最小原则利用S14中得到的Y通道的离散电压包络信号和S15得到的拟合后的Y通道的离散电压包络信号建立Y通道的离散电压包络信号目标函数;
式中,Jx和Jy表示X通道和Y通道的离散电压包络信号目标函数。
根据式(20),辨识得到拟合后的X通道的离散电压包络信号中检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果及拟合后的Y通道的离散电压包络信号中检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果;
根据辨识的X通道的检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果计算X通道的不平衡误差结果;根据辨识的Y通道的检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果计算Y通道的不平衡误差结果;辨识得到检测通道的不平衡误差结果包括等效电极偏角误差及不平衡增益误差:
3、利用得到的所述不平衡误差结果建立检测电压误差补偿公式,根据检测电压误差补偿公式利用前馈增益补偿控制器或数字控制器补偿算法对所述不平衡误差进行补偿,完成检测通道的不平衡误差补偿:
根据式(21)的等效电极偏角误差及不平衡增益误差建立陀螺检测通道检测电压误差补偿公式,根据检测电压误差补偿公式通过在检测通道串联前馈补偿环节或在数字控制器解算方法中增加数值补偿程序:
其中,Ux_c(k)表示X通道第k次补偿后的检测电极信号, 表示包含X通道不平衡误差的X通道电压信号;Ux_c(k-1)表示X通道第k-1次补偿后的检测电极信号;Uy_c(k)表示Y通道第k次补偿后的检测电极信号, 表示包含Y通道不平衡误差的Y通道电压信号;Uy_c(k-1)表示Y通道第k-1次补偿后的检测电极信号;表示第k次辨识的检测通道不平衡增益误差;表示第k次辨识的检测通道等效电极偏角误差。
通过上述方法完成了速率积分半球谐振陀螺检测通道不平衡误差的辨识(公式(21))与补偿(公式(22)),以达到提升陀螺测控精度的目的。
将第k次补偿完成后的速率积分半球谐振陀螺设置为正常工作状态,并将速率积分半球谐振陀螺安装在高精度速率转台的台面上,给定高精度速率转台一个角速度,使速率积分半球谐振陀螺处于高速旋转状态,计算此时速率积分半球谐振陀螺检测通道的不平衡误差D,判断所述不平衡误差D是否满足速率积分半球谐振陀螺的精度要求,若满足速率积分半球谐振陀螺的精度要求,不平衡误差补偿成功;否则,不平衡误差补偿失败,获取此时速率积分半球谐振陀螺的驻波方位角(角位置信息)及角速率,根据驻波方位角(角位置信息)及角速率利用公式(14)辨识所述不平衡误差D的主要组成(等效电极偏角误差、不平衡增益误差),具体为:绘制陀螺驻波角位置-时间曲线图和陀螺驻波角速率-时间曲线图,利用公式(14)得到两条曲线间的相位关系,根据两条曲线间的相位关系分析确定不平衡误差D的主要组成,不平衡误差包括等效电极偏角误差及不平衡增益误差,利用公式(24)和公式(25)确定所述不平衡误差的补偿值,根据不平衡误差D的主要组成利用公式(22)进行一一补偿,即依次完成等效电极偏角误差及检测通道不平衡增益误差的精确补偿,从而降低两种误差补偿过程中的相互影响。通过依次对误差主成分进行补偿也使得补偿过程更具备针对性,更易达到补偿目标,提高补偿效率。
所述速率积分半球谐振陀螺的精度要求:
所述不平衡误差补偿值公式:
当不平衡误差主要组成为等效电极偏角误差时,不平衡误差补偿值公式为:
若不平衡误差主要组成为不平衡增益误差时,不平衡误差补偿值公式为:
通过上述方法完成了速率积分半球谐振陀螺检测通道不平衡误差的辨识与补偿,以达到提升陀螺测控精度的目的,所述速率积分半球谐振陀螺输出的角速率在检测通道不平衡误差辨识及补偿后为:
Claims (10)
1.一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:它包括以下步骤:
S1、获取自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号;
S2、根据误差平方和最小原则利用所述离散电压包络信号建立离散电压包络信号目标函数;
S3、利用离散电压包络信号目标函数辨识速率积分半球谐振陀螺检测通道的不平衡误差,得到检测通道的不平衡误差结果,完成检测通道的不平衡误差辨识;
S4、利用得到的所述不平衡误差结果建立检测电压误差补偿公式,根据检测电压误差补偿公式利用前馈增益补偿控制器或数字控制器补偿算法对所述不平衡误差进行补偿,完成检测通道的不平衡误差补偿;
S5、对检测通道的不平衡误差补偿进行校验。
2.根据权利要求1中所述的一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:所述S1中速率积分半球谐振陀螺检测通道包括X通道和Y通道。
3.根据权利要求2中所述的一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:所述S1中获取自由振动和高速旋转状态下的速率积分半球谐振陀螺检测通道的离散电压包络信号,具体过程为:
S11、将速率积分半球谐振陀螺安装在速率转台的台面上,速率积分半球谐振陀螺的敏感轴与转台的回转轴平行,给定速率转台的角速度,将速率积分半球谐振陀螺处于高速旋转状态,并将速率积分半球谐振陀螺设置为自由振动状态,获取自由振动和高速旋转状态下的速率积分半球谐振陀螺X通道的电压信号和Y通道的电压信号:
其中,Uxd表示速率积分半球谐振陀螺在自由振动和高速旋转状态下X通道的电压信号;
Uyd表示速率积分半球谐振陀螺在自由振动和高速旋转状态下Y通道的电压信号;
Gx表示X通道存在不平衡误差时的信号增益;
Gy表示Y通道存在不平衡误差时的信号增益;
G表示专用电容检测电路的电容-电压转换增益;
a表示半球谐振子主驻波振幅;
kg表示速率积分半球谐振陀螺驻波进动系数;
Ω表示速率积分半球谐振陀螺外界输入角速率;
t表示系统工作时间;
2θ0表示半球谐振子驻波初始方位角;
δθ表示速率积分半球谐振陀螺检测通道的等效电极偏角;
ω表示半球谐振子基础振动频率;
e表示自然常数;
τ表示半球谐振子平均机械振动时间常数;
S12、对所述X通道的电压信号进行平方,得到平方后的X通道的电压信号;
对所述Y通道的电压信号进行平方,得到平方后的Y通道的电压信号;
S13、利用低通滤波器对平方后的X通道的电压信号进行处理,得到X通道的电压包络信号;
利用低通滤波器对平方后的Y通道的电压信号进行处理,得到Y通道的电压包络信号;
S14、对X通道的电压包络信号进行离散处理,得到X通道的离散电压包络信号;
对Y通道的电压包络信号进行离散处理,得到Y通道的离散电压包络信号;
其中,Vxd_z(kN)表示X通道的离散系统采样点kN的离散电压包络信号;
Vyd_z(kN)表示Y通道的离散系统采样点kN的离散电压包络信号;
Axd表示X通道检测信号的最大幅度,Axd=GxGa;
Ayd表示Y通道检测信号的最大幅度,Ayd=GyGa;
Te表示离散系统采样周期;
θxd表示存在等效电极偏角误差的X通道的检测电极方位角;
θyd表示存在等效电极偏角误差的Y通道的检测电极方位角;
NS(kN)表示零均值干扰及噪声的集合;
S15、对X通道的离散电压包络信号进行数据拟合,得到拟合后的X通道的离散电压包络信号;
对Y通道的离散电压包络信号进行数据拟合,得到拟合后的Y通道的离散电压包络信号;
4.根据权利要求3中所述的一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:所述S2中根据误差平方和最小原则利用所述离散电压包络信号建立离散电压包络信号目标函数,具体过程为:
根据误差平方和最小原则利用S14中得到的X通道的离散电压包络信号和S15得到的拟合后的X通道的离散电压包络信号建立X通道的离散电压包络信号目标函数;
根据误差平方和最小原则利用S14中得到的Y通道的离散电压包络信号和S15得到的拟合后的Y通道的离散电压包络信号建立Y通道的离散电压包络信号目标函数;
其中,Jx表示X通道的离散电压包络信号目标函数;
Jy表示Y通道的离散电压包络信号目标函数;
N表示离散系统采样点的总数;
当X通道的离散电压包络信号目标函数和Y通道的离散电压包络信号均取最小值时,得到X通道的检测信号幅值最优估计结果、Y通道的检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果、Y通道的检测电极等效方位角最优估计结果、速率积分半球谐振陀螺进动系数最优估计结果、半球谐振子平均机械振动时间常数的最优估计结果。
5.根据权利要求4中所述的一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:所述S3中检测通道的不平衡误差结果包括等效电极偏角误差和不平衡增益误差。
6.根据权利要求5中所述的一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:所述S3中利用离散电压包络信号目标函数辨识速率积分半球谐振陀螺检测通道的不平衡误差,得到检测通道的不平衡误差结果,具体过程为:
S31、利用所述X通道的离散电压包络信号目标函数辨识拟合后的X通道的离散电压包络信号中检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果;
利用所述Y通道的离散电压包络信号目标函数辨识拟合后的Y通道的离散电压包络信号中检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果;
S32、根据辨识的X通道的检测信号幅值最优估计结果、X通道的检测电极等效方位角最优估计结果计算X通道的不平衡误差结果;
根据辨识的Y通道的检测信号幅值最优估计结果、Y通道的检测电极等效方位角最优估计结果计算Y通道的不平衡误差结果;
8.根据权利要求7中所述的一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法,其特征在于:所述S5中对检测通道的不平衡误差补偿进行校验,具体过程为:
S51、建立陀螺角速率-陀螺检测通道不平衡误差模型,对陀螺角速率-陀螺检测通道不平衡误差模型进行训练,输入检测通道的不平衡误差结果,输出速率积分半球谐振陀螺的角速率,得到训练好的陀螺角速率-陀螺检测通道不平衡误差模型,具体过程为:
S511、获取速率积分半球谐振陀螺仅包含半球谐振子驻波方位角和振幅信息的X通道的电压信号和Y通道的电压信号:
其中,Ux_LPF表示仅包含半球谐振子驻波方位角及振幅信息的X通道理想电压信号;
Uy_LPF表示仅包含半球谐振子驻波方位角及振幅信息的Y通道理想电压信号;
2θ表示半球谐振子驻波理想方位角;
S512、根据S511得到的X通道的电压信号计算包含不平衡误差的X通道电压信号;
根据S511得到的Y通道的电压信号计算包含不平衡误差的Y通道电压信号;
S513、根据X通道电压信号和Y通道电压信号的相对关系得到包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角:
其中,2θd表示包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角;
S514、对包含X通道不平衡误差和Y通道不平衡误差的半球谐振子驻波方位角求导,并结合外界输入角速度和速率积分半球谐振陀螺进动系数,得到陀螺角速率-陀螺检测通道不平衡误差模型:
Ωd=Ω-(2δθΩsin4θ+δGxyΩcos4θ) (10)
其中,Ωd表示速率积分半球谐振陀螺输出角速率;
4θ表示半球谐振子振型方位角的二倍角;
S52、将S4中不平衡误差补偿后的速率积分半球谐振陀螺的状态设置为工作状态和高速旋转状态,执行S1-S3,得到所述速率积分半球谐振陀螺在工作状态和高速旋转状态下的检测通道的不平衡误差,判断所述不平衡误差是否满足速率积分半球谐振陀螺的精度要求,若满足速率积分半球谐振陀螺的精度要求,不平衡误差补偿成功;
否则,不平衡误差补偿失败,获取所述速率积分半球谐振陀螺的角位置信息,对角位置信息进行差分得到角速率信息,根据所述角位置信息和所述角速率信息绘制陀螺驻波角位置-时间曲线图和陀螺驻波角速率-时间曲线图,得到两条曲线间的相位关系,利用S514中陀螺角速率-陀螺检测通道不平衡误差模型根据两条曲线间的相位关系辨识所述速率积分半球谐振陀螺检测通道不平衡误差,不平衡误差包括等效电极偏角误差及不平衡增益误差,利用不平衡误差补偿值公式确定所述不平衡误差的补偿值,再根据S4中建立的检测电压误差补偿公式进行补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210679577.4A CN115077564B (zh) | 2022-06-15 | 2022-06-15 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210679577.4A CN115077564B (zh) | 2022-06-15 | 2022-06-15 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115077564A true CN115077564A (zh) | 2022-09-20 |
CN115077564B CN115077564B (zh) | 2023-05-12 |
Family
ID=83252575
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210679577.4A Active CN115077564B (zh) | 2022-06-15 | 2022-06-15 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115077564B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115855121A (zh) * | 2023-02-28 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的误差自校准方法 |
CN116499497A (zh) * | 2023-06-28 | 2023-07-28 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导系统误差自校准方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1649275A1 (ru) * | 1988-06-08 | 1991-05-15 | Московский авиационный технологический институт им.К.Э.Циолковского | Устройство дл автоматической балансировки роторов гироскопов |
RU2176780C1 (ru) * | 2000-08-30 | 2001-12-10 | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" | Способ определения истинного курса с помощью двухканального гироскопического датчика угловой скорости |
US20150276407A1 (en) * | 2013-01-22 | 2015-10-01 | MCube Inc. | Multi-axis integrated inertial sensing device |
US9170105B1 (en) * | 2010-12-23 | 2015-10-27 | Lockheed Martin Corporation | System and method for improved accuracy gyro rate sensing |
CN113670340A (zh) * | 2021-09-13 | 2021-11-19 | 哈尔滨工业大学 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
CN113899365A (zh) * | 2021-11-22 | 2022-01-07 | 哈尔滨工业大学 | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 |
CN114440852A (zh) * | 2022-03-15 | 2022-05-06 | 哈尔滨工业大学 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
-
2022
- 2022-06-15 CN CN202210679577.4A patent/CN115077564B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1649275A1 (ru) * | 1988-06-08 | 1991-05-15 | Московский авиационный технологический институт им.К.Э.Циолковского | Устройство дл автоматической балансировки роторов гироскопов |
RU2176780C1 (ru) * | 2000-08-30 | 2001-12-10 | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" | Способ определения истинного курса с помощью двухканального гироскопического датчика угловой скорости |
US9170105B1 (en) * | 2010-12-23 | 2015-10-27 | Lockheed Martin Corporation | System and method for improved accuracy gyro rate sensing |
US20150276407A1 (en) * | 2013-01-22 | 2015-10-01 | MCube Inc. | Multi-axis integrated inertial sensing device |
CN113670340A (zh) * | 2021-09-13 | 2021-11-19 | 哈尔滨工业大学 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
CN113899365A (zh) * | 2021-11-22 | 2022-01-07 | 哈尔滨工业大学 | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 |
CN114440852A (zh) * | 2022-03-15 | 2022-05-06 | 哈尔滨工业大学 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
Non-Patent Citations (1)
Title |
---|
王昊 等: "基于PXI平台的半球谐振子相位幅度控制", 《飞控与探测》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115855121A (zh) * | 2023-02-28 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的误差自校准方法 |
CN115855121B (zh) * | 2023-02-28 | 2023-04-28 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺的误差自校准方法 |
CN116499497A (zh) * | 2023-06-28 | 2023-07-28 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导系统误差自校准方法 |
CN116499497B (zh) * | 2023-06-28 | 2023-09-05 | 中国船舶集团有限公司第七〇七研究所 | 基于模态反转的半球谐振陀螺惯导系统误差自校准方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115077564B (zh) | 2023-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115077564B (zh) | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 | |
CN115876182B (zh) | 一种半球谐振陀螺的电极误差建模方法 | |
EP1579174B1 (en) | Method of calibrating bias drift with temperature for a vibrating structure gyroscope | |
CN113899365B (zh) | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 | |
CN105783899B (zh) | 具有原位偏差自校准的高带宽科里奥利振动陀螺仪(cvg) | |
CN115540903A (zh) | 一种半球谐振陀螺阻尼和刚度不均匀的修调方法及系统 | |
CN113551660B (zh) | 一种电极角度存在误差时的半球谐振陀螺振型角获取方法 | |
CN111578966B (zh) | 一种基于lms算法的半球谐振子特征参数辨识方法 | |
CN114440933B (zh) | 一种谐振陀螺仪旋转调制标度自校正系统 | |
CN115773741B (zh) | 半球谐振陀螺仪自补偿控制系统及方法 | |
CN113447047B (zh) | 速率积分陀螺检测电极误差辨识方法、装置、系统及介质 | |
CN113686356A (zh) | 基于rbf网络的谐振陀螺零偏在线自补偿系统及方法 | |
CN114543843B (zh) | 一种谐振陀螺仪通道误差标定校正方法 | |
CA2240824C (en) | Low quantization method and apparatus for vibratory rotation sensors | |
CN115420269B (zh) | 谐振结构频率裂解辨识与修调方法及平台 | |
CN114440852B (zh) | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 | |
CN115855121A (zh) | 一种半球谐振陀螺的误差自校准方法 | |
CN114166242A (zh) | 一种半球谐振陀螺检测信号不均匀性的校准方法及系统 | |
CN109855668A (zh) | 磁角度传感器的自校准方法、装置、磁角度传感器及系统 | |
CN112964242B (zh) | 一种石英音叉陀螺表头机械耦合误差测试系统及测试方法 | |
Xu et al. | Single-channel control for hemispherical resonator gyro based on time division multiplexing and demultiplexing | |
US6647785B2 (en) | Nuclear radiation hard high accuracy rotation sensor system | |
CN117629163A (zh) | 基于双模态同时激励的mems陀螺模态匹配方法和角速度读出方法 | |
EP3043146B1 (en) | Approach for control redistribution of coriolis vibratory gyroscope ("cvg") for performance improvement | |
CN114046804B (zh) | 速率积分陀螺驱动电极误差辨识方法、装置、系统和介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |