[发明专利]一种谐振陀螺仪通道误差标定校正方法有效
申请号: | 202210246190.X | 申请日: | 2022-03-14 |
公开(公告)号: | CN114543843B | 公开(公告)日: | 2023-06-20 |
发明(设计)人: | 丛正;王宝琛;赵小明;张悦;史炯;李世杨 | 申请(专利权)人: | 中国船舶重工集团公司第七0七研究所 |
主分类号: | G01C25/00 | 分类号: | G01C25/00;G01C19/56 |
代理公司: | 天津盛理知识产权代理有限公司 12209 | 代理人: | 刘英梅 |
地址: | 300131 天*** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 谐振 陀螺仪 通道 误差 标定 校正 方法 | ||
1.一种谐振陀螺仪通道误差标定校正方法,其特征在于:包括如下步骤:
步骤1、建立通道误差辨识模型,并将建立的模型置于谐振陀螺仪的控制系统;
步骤2、根据任务需要,确定待辨识误差参数个数n,调用通道误差辨识模型;
步骤3、初始化驻波方位角θ,将其置于随机初始位置θ0;
步骤4、移动驻波方位角θ,使其置于θi=θ0+iπ/2n,i=1,…,n;
步骤5、在步骤4驻波方位角θ移动n次的过程中,计算各驻波方位角θi处的额外漂移角;
步骤6、根据额外漂移角及通道误差辨识模型,辨识计算n个误差参数;
步骤7、根据计算所得各误差参数,代入误差模型的相应位置,修正当前回路系数;
步骤8、判断各参数的计算残差ek是否满足所设终止条件ekeset,统计完成修正的参数个数k;
步骤9、更新待辨识参数数量n及通道误差辨识模型;
步骤10、若待辨识参数n不为零,则更新随机初始驻波方位角θ0=θ0+r,返回步骤2;否则,停止迭代;
步骤1中涉及的通道误差包括检测通道误差A和驱动通道误差B;
检测通道误差A包含电极增益偏差Δkd、电极位置偏差Δθd、电极相移偏差Δφd,针对检测通道误差A,计算所得驻波角度与驻波真实角度间存在与驻波方位角θ相关的误差,如公式(1)所示:
式中——a为波腹振幅;
——b为波节振幅;
——为驻波角度计算值;
——Δkd为检测电极增益偏差;
——Δθd为检测电极位置偏差;
——Δφd为检测电极相移偏差;
驱动通道误差B包含电极增益偏差Δke、电极位置偏差和电极相移偏差Δφe;对于驱动通道误差B,其主要表现为控制信号的交叉耦合,由此引起各驻波方位角θ处额外的漂移Δεe,建立驱动误差B对驻波方位角θ的误差方程如式(2)所示:
式中——Δke为X驱动电极增益偏差;
——分别为X、Y驱动电极位置偏差;
——Δφe为Y驱动电极相移偏差;
——Δεe为驱动误差引入额外漂移;
——SF为电极施力标度因数;
——为额外漂移角;
——Ca为稳幅控制信号;
——Cq为正交控制信号;
因检测通道误差A的存在,驻波真实角度未知,将驱动误差方程(2)中的驻波角度θ改写为角度计算值得到通道误差辨识模型,如式(3)所示:
2.根据权利要求1所述的谐振陀螺仪通道误差标定校正方法,其特征在于:步骤4中,驻波的旋转可通过外界载体转速Ω提供,也可通过施加主动进动信号Cp提供。
3.根据权利要求2所述的谐振陀螺仪通道误差标定校正方法,其特征在于:步骤5中,当采用外部载体提供转动时,计算额外漂移角,其公式为:
式中——为额外漂移角;
——为驻波方位角θi位置处,计算所得驻波方位角θ;
——α为布莱恩系数真值;
——Ω为外部载体转速;
——t为转动时间。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国船舶重工集团公司第七0七研究所,未经中国船舶重工集团公司第七0七研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210246190.X/1.html,转载请声明来源钻瓜专利网。