一种基于惯性寻北装置的抗冲击寻北解算方法
基本信息
申请号 | CN201810891530.8 | 申请日 | - |
公开(公告)号 | CN109084761B | 公开(公告)日 | 2021-09-10 |
申请公布号 | CN109084761B | 申请公布日 | 2021-09-10 |
分类号 | G01C21/16 | 分类 | 测量;测试; |
发明人 | 周全;唐李;席梅丽;刘斌;罗家童 | 申请(专利权)人 | 合肥正阳光电科技有限责任公司 |
代理机构 | 合肥天明专利事务所(普通合伙) | 代理人 | 韩燕;金凯 |
地址 | 230088 安徽省合肥市高新区望江西路527号 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了一种基于惯性寻北装置的抗冲击寻北解算方法,首先进行数据采集,得到陀螺测量数据G1和加速度计测量数据A1,然后基于卡尔曼滤波器对陀螺数据进行滤波,再将单个位置的测试数据进行分组,并对每个分组数据的发散程度进行量化,之后基于格拉布斯滤波算法,剔除数值偏差异常的分组,最后再依次进行数据统计、转位控制、姿态解算和圆周补偿,得到惯性寻北装置航向角和姿态角的解算结果。本发明采用多种滤波方式,对测量数据进行滤波处理,减少了冲击振动对寻北结果的影响,并采用了倾斜状态无纬度寻北解算方法,从而得到精确的解算结果。 |
