发明公开
- 专利标题: 一种地图辅助的惯性预积分行人导航方法
-
申请号: CN201910393891.4申请日: 2019-05-13
-
公开(公告)号: CN110207692A公开(公告)日: 2019-09-06
- 发明人: 袁诚 , 吕品 , 赖际舟 , 朱超群 , 杨子寒 , 何容
- 申请人: 南京航空航天大学
- 申请人地址: 江苏省南京市秦淮区御道街29号
- 专利权人: 南京航空航天大学
- 当前专利权人: 南京航空航天大学
- 当前专利权人地址: 江苏省南京市秦淮区御道街29号
- 代理机构: 南京经纬专利商标代理有限公司
- 代理商 施昊
- 主分类号: G01C21/16
- IPC分类号: G01C21/16 ; G01C21/00 ; G01C25/00
摘要:
本发明公开了一种地图辅助的惯性预积分行人导航方法。周期采集k时刻加速度计数据和陀螺仪数据;利用获取的惯性传感器测量数据预积分预测k时刻载体的导航信息;判断导航系统是否初始化,若已经初始化,则进行地图匹配检测,若匹配成功,则进行联合地图、惯性误差进行位姿全局优化,并输出载体导航信,若匹配失败,则进行零速检测,若为非零速,则进行惯性预积分求解位姿,若存在零速,则联合惯性误差、零速约束优化求解位姿,输出载体导航信。本发明利用惯性传感器测量值进行预积分优化求解输出行人导航信息,并进行零速约束校正优化,且引入地图信息对全局轨迹进行优化,消除累积误差。
公开/授权文献
- CN110207692B 一种地图辅助的惯性预积分行人导航方法 公开/授权日:2021-03-30