-
公开(公告)号:CN114279438B
公开(公告)日:2023-11-17
申请号:CN202111553624.2
申请日:2021-12-17
Applicant: 东南大学
Abstract: 本发明提出了基于PSO和ICCP的地磁匹配导航方法,步骤包括:1、在地磁匹配时间段内获取地磁测量值以及同时刻的惯性导航系统(INS)指示坐标;2、采用多次匹配选取最优轨迹的策略,由滑动窗口在全局搜索区域中生成子区域,每次匹配分别在不同子区域内由四叉树生成初始化粒子,再先后使用PSO、ICCP对惯导指示轨迹分别进行粗、细匹配,从而获取一系列的候选轨迹;3、将最优轨迹的选取视作多属性决策问题,对每一条候选轨迹,分别使用其与真实轨迹的磁测序列的轨迹相关性和ICCP算法收敛度进行综合评价,进而选取最优轨迹输出,可以有效消除惯导累计误差,提高组合导航系统的定位精度。
-
公开(公告)号: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中位姿估计作为地图初始值来连接两个地图,有利于扩大系统的使用范围。
-
公开(公告)号: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中位姿估计作为地图初始值来连接两个地图,有利于扩大系统的使用范围。
-
公开(公告)号:CN114279438A
公开(公告)日:2022-04-05
申请号:CN202111553624.2
申请日:2021-12-17
Applicant: 东南大学
Abstract: 本发明提出了基于PSO和ICCP的地磁匹配导航方法,步骤包括:1、在地磁匹配时间段内获取地磁测量值以及同时刻的惯性导航系统(INS)指示坐标;2、采用多次匹配选取最优轨迹的策略,由滑动窗口在全局搜索区域中生成子区域,每次匹配分别在不同子区域内由四叉树生成初始化粒子,再先后使用PSO、ICCP对惯导指示轨迹分别进行粗、细匹配,从而获取一系列的候选轨迹;3、将最优轨迹的选取视作多属性决策问题,对每一条候选轨迹,分别使用其与真实轨迹的磁测序列的轨迹相关性和ICCP算法收敛度进行综合评价,进而选取最优轨迹输出,可以有效消除惯导累计误差,提高组合导航系统的定位精度。
-
-
-