一种导航系统的故障处理方法、电子设备及存储介质

基本信息

申请号 CN202110988512.3 申请日 -
公开(公告)号 CN113703019A 公开(公告)日 2021-11-26
申请公布号 CN113703019A 申请公布日 2021-11-26
分类号 G01S19/40(2010.01)I;G01C25/00(2006.01)I 分类 测量;测试;
发明人 熊小军;赵丹;李向东 申请(专利权)人 北京宇系航通科技有限公司
代理机构 北京德崇智捷知识产权代理有限公司 代理人 王金双
地址 100190 北京市海淀区学院路37号内
法律状态 -

摘要

摘要 一种导航系统的故障处理方法,包括:1)初始化标志位,分别设置GPS故障标志位和陀螺、加速度计修正标志位;2)读取陀螺、加速度计数据和GPS输出故障标志,当读取的GPS输出故障标志不能定位且陀螺、加速度计可以修正测量数据时,执行步骤3),否则执行步骤4);3)进行陀螺、加速度计修正;4)根据读取的陀螺、加速度计数据进行惯导位姿解算和卡尔曼滤波的一步预测,判断GPS输入的标志位是否有效定位,若是则执行步骤5),否则执行步骤6);5)进行卡尔曼滤波,执行位姿的反馈校正,输出校正后的结果;6)进行传感器修正条件判定,输出惯导解算的位姿。本发明的导航系统的故障处理方法,不会降低系统的运行效率。