发明授权
CN109443354B 基于萤火虫群优化PF的视觉-惯性紧耦合组合导航方法
失效 - 权利终止
- 专利标题: 基于萤火虫群优化PF的视觉-惯性紧耦合组合导航方法
-
申请号: CN201811590654.9申请日: 2018-12-25
-
公开(公告)号: CN109443354B公开(公告)日: 2020-08-14
- 发明人: 李秀源 , 高文学 , 张加书
- 申请人: 中北大学
- 申请人地址: 山西省太原市尖草坪区学院路3号
- 专利权人: 中北大学
- 当前专利权人: 中北大学
- 当前专利权人地址: 山西省太原市尖草坪区学院路3号
- 代理机构: 太原新航路知识产权代理事务所
- 代理商 王勇
- 主分类号: G01C21/18
- IPC分类号: G01C21/18 ; G01C21/16 ; G01C21/20
摘要:
本发明涉及视觉‑惯性紧耦合组合导航方法,具体是一种基于萤火虫群优化PF的视觉‑惯性紧耦合组合导航方法。本发明改善了视觉‑惯性紧耦合组合导航方法的实时性和导航精度。基于萤火虫群优化PF的视觉‑惯性紧耦合组合导航方法,该方法是采用如下步骤实现的:步骤S1:在运载体上安装捷联惯导系统和双目视觉里程计;步骤S2:建立线性状态方程;建立非线性量测方程;步骤S3:利用基于萤火虫群优化的PF对视觉‑惯性紧耦合组合导航系统进行非线性滤波,实现视觉‑惯性紧耦合组合导航系统的数据融合;步骤S4:根据步骤S3的非线性滤波结果对捷联惯导系统的解算结果进行校正。本发明适用于视觉‑惯性紧耦合组合导航。
公开/授权文献
- CN109443354A 基于萤火虫群优化PF的视觉-惯性紧耦合组合导航方法 公开/授权日:2019-03-08
IPC分类: