一种导航系统的故障处理方法、电子设备及存储介质
基本信息
申请号 | 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)进行传感器修正条件判定,输出惯导解算的位姿。本发明的导航系统的故障处理方法,不会降低系统的运行效率。 |
