一种基于惯性寻北装置的抗冲击寻北解算方法

基本信息

申请号 CN201810891530.8 申请日 -
公开(公告)号 CN109084761B 公开(公告)日 2021-09-10
申请公布号 CN109084761B 申请公布日 2021-09-10
分类号 G01C21/16 分类 测量;测试;
发明人 周全;唐李;席梅丽;刘斌;罗家童 申请(专利权)人 合肥正阳光电科技有限责任公司
代理机构 合肥天明专利事务所(普通合伙) 代理人 韩燕;金凯
地址 230088 安徽省合肥市高新区望江西路527号
法律状态 -

摘要

摘要 本发明公开了一种基于惯性寻北装置的抗冲击寻北解算方法,首先进行数据采集,得到陀螺测量数据G1和加速度计测量数据A1,然后基于卡尔曼滤波器对陀螺数据进行滤波,再将单个位置的测试数据进行分组,并对每个分组数据的发散程度进行量化,之后基于格拉布斯滤波算法,剔除数值偏差异常的分组,最后再依次进行数据统计、转位控制、姿态解算和圆周补偿,得到惯性寻北装置航向角和姿态角的解算结果。本发明采用多种滤波方式,对测量数据进行滤波处理,减少了冲击振动对寻北结果的影响,并采用了倾斜状态无纬度寻北解算方法,从而得到精确的解算结果。