[发明专利]一种陀螺仪系统测试用漂移解算分析方法有效
申请号: | 202110705985.8 | 申请日: | 2021-06-24 |
公开(公告)号: | CN113432623B | 公开(公告)日: | 2023-04-28 |
发明(设计)人: | 覃刚;范云鹏;姚宇;林晓彬;石凤仪;于丹 | 申请(专利权)人: | 中国船舶重工集团公司第七0七研究所 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 天津盛理知识产权代理有限公司 12209 | 代理人: | 王雨晴 |
地址: | 300131 天*** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 陀螺仪 系统 测试 漂移 分析 方法 | ||
1.一种陀螺仪系统测试用漂移解算分析方法,其特征在于:包括以下步骤:
步骤1、采集惯导系统数据;
步骤2、根据步骤1所采集的数据解算水平陀螺漂移、方位陀螺的漂移、斜漂、常值漂移和随机漂移;
步骤3、将步骤2中解算陀螺漂移结果在界面显示并同步绘制陀螺漂移曲线图;
步骤4、陀螺系统测试结束,根据测漂结果,生成陀螺仪系统测试结果;
所述步骤2的具体步骤包括:
(1)水平陀螺漂移解算:
在试验室静态下,根据水平阻尼系统误差关系估算两个水平陀螺的漂移:
式中,δVx、δVy为系统速度误差,静态下就是系统速度,为系统纬度误差,试验室条件下也是已知的;
γ为航向误差,静态下就是系统当前航向Hi减去最后一次校准后的初始航向H0,
γ=Hi-H0 (3)
如果不是静态测试还需要外参考信息才能估算两个水平陀螺漂移;
(2)方位陀螺漂移解算:
24小时静态阶段解算方位陀螺漂移有以下两种方法:
方法一:采用Kalman滤波的方法进行估计,根据惯导系统误差方程建立状态方程和观测方程,以位置和速度信息为观测量,试验室条件下知道准确的位置信息和速度信息;
方法二:采用GPS校的方法估算方位陀螺漂移;
(3)斜漂和常值漂移估算:
将估算的方位陀螺漂移用最小二乘法拟合;
最小二乘法一次曲线拟合公式如下:
I(j)=j·Ts+t0,j=1,2,…N,Ts为时间间隔,
(单位为度/小时),
则斜漂为
常值漂移为
(4)随机漂移的标准差计算:
假设估算出的东向陀螺漂移为对应时间为t_ex,拟合出的斜率为常值漂移为拟合曲线为则随机漂移标准差为
其中,水平陀螺漂移对应时间起点是零,时间间隔为10秒,方位陀螺漂移对应时间t_zx起点是2小时,时间间隔为10秒。
2.根据权利要求1所述的一种陀螺仪系统测试用漂移解算分析方法,其特征在于:所述步骤1采集的惯导系统数据包括:LO、LA、VE、VN、VZ、R、P、HP。
3.根据权利要求1所述的一种陀螺仪系统测试用漂移解算分析方法,其特征在于:所述步骤2第(2)步的24小时静态阶段解算方位陀螺漂移的方法一的具体方法为:
根据惯导系统误差关系建立系统的状态方程
和量测方程
Z(t)=HX(t)+V(t)
状态变量取15维矢量,
测量值Z(t)是位置误差和速度误差、速度误差和航向变化量,
将连续方程离散化,根据Kalman滤波基本方程估算方位陀螺漂移:
得到方位陀螺常值漂移估计值
4.根据权利要求1所述的一种陀螺仪系统测试用漂移解算分析方法,其特征在于:所述步骤2第(2)步的24小时静态阶段解算方位陀螺漂移的方法二的具体方法为:
记t0、t1、t2为三个时刻,它们的间隔为T1=T2=3600s;
在这三个时刻分别采集和保存:
试验室静态下
其中:
δλ(·)=λINS-λGPS (10)
γ(·)=HP-H0 (11)
分别为纬度误差、经度误差、航向误差;
利用保存的信息计算
最后解出北向和方位陀螺漂移:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国船舶重工集团公司第七0七研究所,未经中国船舶重工集团公司第七0七研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110705985.8/1.html,转载请声明来源钻瓜专利网。