基于PSO和ICCP的地磁匹配导航方法

    公开(公告)号:CN114279438B

    公开(公告)日:2023-11-17

    申请号:CN202111553624.2

    申请日:2021-12-17

    Applicant: 东南大学

    Abstract: 本发明提出了基于PSO和ICCP的地磁匹配导航方法,步骤包括:1、在地磁匹配时间段内获取地磁测量值以及同时刻的惯性导航系统(INS)指示坐标;2、采用多次匹配选取最优轨迹的策略,由滑动窗口在全局搜索区域中生成子区域,每次匹配分别在不同子区域内由四叉树生成初始化粒子,再先后使用PSO、ICCP对惯导指示轨迹分别进行粗、细匹配,从而获取一系列的候选轨迹;3、将最优轨迹的选取视作多属性决策问题,对每一条候选轨迹,分别使用其与真实轨迹的磁测序列的轨迹相关性和ICCP算法收敛度进行综合评价,进而选取最优轨迹输出,可以有效消除惯导累计误差,提高组合导航系统的定位精度。

    一种融合前视声呐与ORB-SLAM3的水下SLAM方法

    公开(公告)号:CN116380079A

    公开(公告)日:2023-07-04

    申请号:CN202310383169.9

    申请日:2023-04-12

    Applicant: 东南大学

    Abstract: 本发明公开了一种融合前视声呐与ORB‑SLAM3的水下SLAM方法,步骤包括:1、获取前视声呐、双目相机以及惯性测量单元(IMU)的量测;2、对声呐图像进行特征跟踪,通过最小化重投影误差得到声呐的相对位姿估计;3、通过ORB‑SLAM3得到相机的位姿估计;4、构建因子图,在视觉跟踪有效时,将3中视觉里程计的位姿估计值作为先验因子,对IMU预积分作为位姿约束因子,将2中声呐相对位姿估计作为约束因子,求解因子图,更新载体位姿估计;5、当视觉跟踪成功,因子图的输出将跟随视觉里程计;如果视觉跟踪丢失,因子图中的声呐和IMU因子继续起作用,系统在到达可跟踪区域后立即初始化新地图,使用4中位姿估计作为地图初始值来连接两个地图,有利于扩大系统的使用范围。

    一种融合前视声呐与ORB-SLAM3的水下SLAM方法

    公开(公告)号:CN116380079B

    公开(公告)日:2025-03-25

    申请号:CN202310383169.9

    申请日:2023-04-12

    Applicant: 东南大学

    Abstract: 本发明公开了一种融合前视声呐与ORB‑SLAM3的水下SLAM方法,步骤包括:1、获取前视声呐、双目相机以及惯性测量单元(IMU)的量测;2、对声呐图像进行特征跟踪,通过最小化重投影误差得到声呐的相对位姿估计;3、通过ORB‑SLAM3得到相机的位姿估计;4、构建因子图,在视觉跟踪有效时,将3中视觉里程计的位姿估计值作为先验因子,对IMU预积分作为位姿约束因子,将2中声呐相对位姿估计作为约束因子,求解因子图,更新载体位姿估计;5、当视觉跟踪成功,因子图的输出将跟随视觉里程计;如果视觉跟踪丢失,因子图中的声呐和IMU因子继续起作用,系统在到达可跟踪区域后立即初始化新地图,使用4中位姿估计作为地图初始值来连接两个地图,有利于扩大系统的使用范围。

    基于PSO和ICCP的地磁匹配导航方法

    公开(公告)号:CN114279438A

    公开(公告)日:2022-04-05

    申请号:CN202111553624.2

    申请日:2021-12-17

    Applicant: 东南大学

    Abstract: 本发明提出了基于PSO和ICCP的地磁匹配导航方法,步骤包括:1、在地磁匹配时间段内获取地磁测量值以及同时刻的惯性导航系统(INS)指示坐标;2、采用多次匹配选取最优轨迹的策略,由滑动窗口在全局搜索区域中生成子区域,每次匹配分别在不同子区域内由四叉树生成初始化粒子,再先后使用PSO、ICCP对惯导指示轨迹分别进行粗、细匹配,从而获取一系列的候选轨迹;3、将最优轨迹的选取视作多属性决策问题,对每一条候选轨迹,分别使用其与真实轨迹的磁测序列的轨迹相关性和ICCP算法收敛度进行综合评价,进而选取最优轨迹输出,可以有效消除惯导累计误差,提高组合导航系统的定位精度。

Patent Agency Ranking