一种基于惯导复用的视觉、惯导、卫导融合定位方法

    公开(公告)号:CN115793001B

    公开(公告)日:2023-05-16

    申请号:CN202310069650.0

    申请日:2023-02-07

    Abstract: 本发明公开了一种基于惯导复用的视觉、惯导、卫导融合定位方法。首先将惯导、双目相机、卫星天线三种传感器刚性固连于同一载体,标定惯导零偏、相机内参和三种传感器间的变换矩阵,接着通过时间戳匹配惯导和视觉数据,基于图优化的视觉SLAM框架对惯导和视觉数据进行融合,得到与视觉数据同频率的视觉‑惯导一级定位结果,通过时间戳匹配惯导和卫导数据,基于扩展卡尔曼滤波对惯导和卫导数据进行融合,得到与惯导数据同频率的惯导‑卫导一级定位结果,然后使用图优化的方式将两种一级定位结果进行二级融合,得到最终的位姿结果。本发明能够通过复用惯导数据提升卫导的位姿输出频率,减小惯导、视觉、卫导数据的时间匹配误差,提高位姿精度。

    一种基于惯导复用的视觉、惯导、卫导融合定位方法

    公开(公告)号:CN115793001A

    公开(公告)日:2023-03-14

    申请号:CN202310069650.0

    申请日:2023-02-07

    Abstract: 本发明公开了一种基于惯导复用的视觉、惯导、卫导融合定位方法。首先将惯导、双目相机、卫星天线三种传感器刚性固连于同一载体,标定惯导零偏、相机内参和三种传感器间的变换矩阵,接着通过时间戳匹配惯导和视觉数据,基于图优化的视觉SLAM框架对惯导和视觉数据进行融合,得到与视觉数据同频率的视觉‑惯导一级定位结果,通过时间戳匹配惯导和卫导数据,基于扩展卡尔曼滤波对惯导和卫导数据进行融合,得到与惯导数据同频率的惯导‑卫导一级定位结果,然后使用图优化的方式将两种一级定位结果进行二级融合,得到最终的位姿结果。本发明能够通过复用惯导数据提升卫导的位姿输出频率,减小惯导、视觉、卫导数据的时间匹配误差,提高位姿精度。

Patent Agency Ranking