发明公开
- 专利标题: 一种改进因子图的车载定位方法
-
申请号: CN202311357210.1申请日: 2023-10-17
-
公开(公告)号: CN117367430A公开(公告)日: 2024-01-09
- 发明人: 胡慧珠 , 权思航 , 周一览 , 陈少华
- 申请人: 浙江大学
- 申请人地址: 浙江省杭州市西湖区余杭塘路866号
- 专利权人: 浙江大学
- 当前专利权人: 浙江大学
- 当前专利权人地址: 浙江省杭州市西湖区余杭塘路866号
- 代理机构: 杭州求是专利事务所有限公司
- 代理商 林超
- 主分类号: G01C21/20
- IPC分类号: G01C21/20 ; G01C21/16 ; G01S19/49 ; G01S19/23
摘要:
本发明公开了一种改进因子图的车载定位方法。本发明包括以下步骤:首先,获取车辆上传感器采集的运动信息数据;接着,根据采集的运动信息数据,构建因子图模型;然后,根据因子图模型,结合采集的运动信息数据,利用多条件分析故障检测方法对GNSS量测值进行故障检测,获得故障GNSS量测信息;再将故障GNSS量测信息通过删除相应因子节点进行隔离后,更新加入到因子图模型中的GNSS量测信息;最后,基于当前因子图模型,对滑动窗口内所有导航状态量进行优化求解,获得车辆载体的导航信息,从而实现车辆载体的融合定位。本发明有效抑制GNSS量测信号异常对导航精度的影响,有效降低系统漏警率。