一种AUV地形匹配导航的鲁棒BSLAM方法

    公开(公告)号:CN109186610B

    公开(公告)日:2020-12-08

    申请号:CN201811197129.0

    申请日:2018-10-15

    Abstract: 本发明属于水下潜航器领域,公开了一种AUV地形匹配导航的鲁棒BSLAM方法,步骤(1):输入测深和惯导数据;步骤(2):数据预处理,得到滤波后的测深数据;步骤(3):位姿图构建:计算弱数据关联,构建新子图,通过地形地位进行闭环检测后,再进行无效闭环检测;步骤(4):后端图优化:利用聚类后的闭环数据计算一致性函数,找出所有类中一致性函数的最小值,然后融合惯导的关键状态的数据并输出修改后的BSLAM轨迹。本发明通过对测深数据和惯导数据的处理和闭环检测,实现了对数据的全局优化,且提高了定位与建图的实时性和一致性,且鲁棒性好,能够减弱测量数据的噪声对导航精度的影响。

    一种AUV海底地形匹配的动态路径规划方法

    公开(公告)号:CN108871351B

    公开(公告)日:2020-12-08

    申请号:CN201810870169.0

    申请日:2018-08-02

    Abstract: 本发明公开了一种AUV海底地形匹配的动态路径规划方法,属于水下航行器导航技术领域。包括环境建模,离线路径规划和在线路径重规划。环境模型通过地形信息和地形来源置信度构建,其中地形特征用地形标准差表示。离线路径规划基于快速搜索随机树算法,改进选择新节点和父节点算法,通过轮盘赌和马氏距离来处理地形信息,以避免低地形信息区域。在AUV沿着离线路径航行,检测到地形信息改变时,在线重规划通过判断地形改变,寻找局部导航最优节点和重优化全局路径等方法实现了对地形变化的判断并保证了导航精度。本发明适用于长航程、高精度的AUV路径规划,特别是当地形信息改变时,通过实时修改路径以保证导航精度和路径距离。

    一种考虑数据关联间耦合关系的位姿图修正方法

    公开(公告)号:CN110260859A

    公开(公告)日:2019-09-20

    申请号:CN201910492175.1

    申请日:2019-06-06

    Abstract: 本发明涉及一种考虑数据关联间耦合关系的位姿图修正方法,属于水下机器人多波束同步定位与建图领域。包括令N为当前位姿图内由地形匹配得到的数据关联个数,i等于1、j等于1;判断j、i、N的大小关系,计算数据关联j给出的数据关联i的置信度Scorei,j,计算数据关联i总置信度Scorei;判断i与N大小关系,根据当前位姿图内所有数据关联的置信度计算置信度阈值Score_thre;置信程度最小的数据关联其置信度若大于置信度阈值,则输出当前位姿图并停止算法,否则将该数据关联判定为无效数据关联,将其在当前位姿图中移除。本方法不需要依赖于辅助设备,算法执行过程中不需要进行图优化过程,计算效率高且可保证算法在线实时运行,应用前景广阔。

    一种水下机器人多波束测深主动同步定位与建图方法

    公开(公告)号:CN115031733B

    公开(公告)日:2024-11-08

    申请号:CN202210488829.5

    申请日:2022-05-06

    Abstract: 本发明属于水下机器人定位与导航技术领域,具体涉及一种水下机器人多波束测深主动同步定位与建图方法。本发明包括水下机器人主动同步定位与建图策略、回环目标点地形信息评价方法、权衡探索和回环动作的效用方程、以及执行回环动作时的路径规划方法。与传统的水下机器人测深信息同步定位与建图方法相比,本发明通过主动对地形进行有目的性地回溯,平衡了回溯和探索之间的关系,从而使得水下机器人能够更有效的在不依赖母船的情况下获得高精度的位置信息和海底地形图。

    一种无人机辅助无人艇动态避障路径规划方法

    公开(公告)号:CN114911240B

    公开(公告)日:2024-09-06

    申请号:CN202210593202.6

    申请日:2022-05-27

    Abstract: 本发明公开了一种无人机辅助无人艇动态避障路径规划方法,将无人机所识别的目标动态障碍物组成一个TSP环路,使用改进遗传算法求解TSP问题解,使目标动态障碍物组成闭环路径,综合障碍物的无碰撞安全区域和护城河环带区域,得到动态障碍物环境下的安全航行点集,连接相应的点集,组成与障碍物无碰撞的路网集合,当无人艇在此动态障碍物区域航行过程中,通过给出起始点和终点,加入上述得到的路网集合,通过寻优算法进行最优路线计算,得到规划路径。本发明路径规划综合考虑了障碍物的无碰撞安全区域和障碍物之间的相对位置,所得到的动态路网集合会随着识别到的动态障碍物位置变化而变化,达到了对全局状态的实时调整。

    一种考虑数据关联间耦合关系的位姿图修正方法

    公开(公告)号:CN110260859B

    公开(公告)日:2022-12-13

    申请号:CN201910492175.1

    申请日:2019-06-06

    Abstract: 本发明涉及一种考虑数据关联间耦合关系的位姿图修正方法,属于水下机器人多波束同步定位与建图领域。包括令N为当前位姿图内由地形匹配得到的数据关联个数,i等于1、j等于1;判断j、i、N的大小关系,计算数据关联j给出的数据关联i的置信度Scorei,j,计算数据关联i总置信度Scorei;判断i与N大小关系,根据当前位姿图内所有数据关联的置信度计算置信度阈值Score_thre;置信程度最小的数据关联其置信度若大于置信度阈值,则输出当前位姿图并停止算法,否则将该数据关联判定为无效数据关联,将其在当前位姿图中移除。本方法不需要依赖于辅助设备,算法执行过程中不需要进行图优化过程,计算效率高且可保证算法在线实时运行,应用前景广阔。

Patent Agency Ranking