一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法

    公开(公告)号:CN110220510B

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

    申请号:CN201910475350.6

    申请日:2019-06-03

    Abstract: 本发明公开一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法,属于水下机器人领域。本发明包括:建立环境模型,结合海底地形特征和地图数据准确程度两部分信息,依据Sigmoid函数将标准差信息非线性映射至[0,1]空间,形成归一化的海底地形特征图;实施H‑RRT*算法进行路径求解,求解过程为迭代‑采样‑寻优的过程。路径规划方法能够充分利用已有信息,如海底地形特征和地图测量数据来源,作为影响水下机器人地形匹配导航性能的因素考虑在内;路径规划方法搜索性能强,可以实现超大地图下的路径搜索和寻优。

    一种基于回转圆的移动式对接轨迹规划方法

    公开(公告)号:CN112486168B

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

    申请号:CN202011298128.2

    申请日:2020-11-19

    Abstract: 本发明公开了一种基于回转圆的移动式对接轨迹规划方法,本发明利用欠驱动AUV与对接装置的相对位置关系,基于回转圆半径与周期,估计对接所需时间并提前进行轨迹规划,本发明结合纯跟踪导引率和视线法导引率,完成回转运动使欠驱动AUV位于对接装置之后且运动同方向,使欠驱动AUV能快速地完成移动式对接回收任务。本发明计算简单,易于实现,且不依赖于精确的AUV模型,在不确定性外界环境干扰下具有较强的自适应性。

    地形分块与地形测点加权的地形匹配定位方法

    公开(公告)号:CN107504974B

    公开(公告)日:2020-09-25

    申请号:CN201710832755.1

    申请日:2017-09-15

    Abstract: 本发明的目的在于提供地形分块与地形测点加权的地形匹配定位方法,影响地形匹配定位精度的有两方面的因素:地形的适配性和地形测量误差。对于适配性较大的局部地形区域可以提供较多的地形信息,而测量误差会使局部地形产生畸变,给地形匹配定位带来负面影响。由于适配性和地形的测量误差都是局部地形的特征,为了体现适配性和局部地形测量误差对匹配定位的影响,将地形进行分块并利用适配性对分块子地形图中的节点进行加权,同时在匹配过程中利用分快子地形的残差统计方差估计子地形图的测量误差,并对子地形图中的节点进行加权处理,利用适配性和测量误差得到的权值同时对子地形图中的节点进行加权,通过迭代过程获得最优的地形匹配定位结果。

    一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法

    公开(公告)号:CN110220510A

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

    申请号:CN201910475350.6

    申请日:2019-06-03

    Abstract: 本发明公开一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法,属于水下机器人领域。本发明包括:建立环境模型,结合海底地形特征和地图数据准确程度两部分信息,依据Sigmoid函数将标准差信息非线性映射至[0,1]空间,形成归一化的海底地形特征图;实施H-RRT*算法进行路径求解,求解过程为迭代-采样-寻优的过程。路径规划方法能够充分利用已有信息,如海底地形特征和地图测量数据来源,作为影响水下机器人地形匹配导航性能的因素考虑在内;路径规划方法搜索性能强,可以实现超大地图下的路径搜索和寻优。

    一种自主式水下航行器归航路径规划方法和装置

    公开(公告)号:CN114610021A

    公开(公告)日:2022-06-10

    申请号:CN202210120059.9

    申请日:2022-02-07

    Abstract: 本发明提供了一种自主式水下航行器归航路径规划方法和装置,该方法包括:获取第一时刻下,母艇的第一位置通信信息,自主式水下航行器的第二位置信息,进而根据第一位置通信信息与第二位置信息获得自主式水下航行器与母艇之间的第一方向矢量;基于第一方向矢量控制自主式水下航行器回转并控制自主式水下航行器直线航行;根据第二位置信息和航向角获得自主式水下航行器在第一时刻的第一状态矩阵;从而获得自主式水下航行器的系统状态方程;基于系统状态方程,通过扩展卡尔曼滤波算法获得自主式水下航行器在第二时刻的路径估计;自主式水下航行器与母艇的距离小于预设距离时控制自主式水下航行器进行对接任务,实现对自主式水下航行器的路径规划。

    一种基于迭代临近搜索的极坐标系目标栅格集合求解方法

    公开(公告)号:CN110245202A

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

    申请号:CN201910475309.9

    申请日:2019-06-03

    Abstract: 本发明公开了一种基于迭代临近搜索的极坐标系目标栅格集合求解方法,属于应用数学领域。本发明通过迭代的方式搜索满足指定约束条件的临近栅格,逐步并入已有目标栅格集合,从而在极坐标系下实现针对指定目标的目标栅格集合扩张和求解。本发明的优点在于:能够在极坐标系下精确计算用户约束条件下的栅格集合,一方面突破了以往的移动窗口法在极坐标系下由于误差较大而不能适用于精确计算的不足,另一方面依据用户约束条件,可以实现代表任意几何形状的栅格集合求解;适用范围广,不仅可用于极坐标系,也可以应用于直角坐标系。

    地形分块与地形测点加权的地形匹配定位方法

    公开(公告)号:CN107504974A

    公开(公告)日:2017-12-22

    申请号:CN201710832755.1

    申请日:2017-09-15

    Abstract: 本发明的目的在于提供地形分块与地形测点加权的地形匹配定位方法,影响地形匹配定位精度的有两方面的因素:地形的适配性和地形测量误差。对于适配性较大的局部地形区域可以提供较多的地形信息,而测量误差会使局部地形产生畸变,给地形匹配定位带来负面影响。由于适配性和地形的测量误差都是局部地形的特征,为了体现适配性和局部地形测量误差对匹配定位的影响,将地形进行分块并利用适配性对分块子地形图中的节点进行加权,同时在匹配过程中利用分快子地形的残差统计方差估计子地形图的测量误差,并对子地形图中的节点进行加权处理,利用适配性和测量误差得到的权值同时对子地形图中的节点进行加权,通过迭代过程获得最优的地形匹配定位结果。

    一种基于迭代临近搜索的极坐标系目标栅格集合求解方法

    公开(公告)号:CN110245202B

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

    申请号:CN201910475309.9

    申请日:2019-06-03

    Abstract: 本发明公开了一种基于迭代临近搜索的极坐标系目标栅格集合求解方法,属于应用数学领域。本发明通过迭代的方式搜索满足指定约束条件的临近栅格,逐步并入已有目标栅格集合,从而在极坐标系下实现针对指定目标的目标栅格集合扩张和求解。本发明的优点在于:能够在极坐标系下精确计算用户约束条件下的栅格集合,一方面突破了以往的移动窗口法在极坐标系下由于误差较大而不能适用于精确计算的不足,另一方面依据用户约束条件,可以实现代表任意几何形状的栅格集合求解;适用范围广,不仅可用于极坐标系,也可以应用于直角坐标系。

    一种基于回转圆的移动式对接轨迹规划方法

    公开(公告)号:CN112486168A

    公开(公告)日:2021-03-12

    申请号:CN202011298128.2

    申请日:2020-11-19

    Abstract: 本发明公开了一种基于回转圆的移动式对接轨迹规划方法,本发明利用欠驱动AUV与对接装置的相对位置关系,基于回转圆半径与周期,估计对接所需时间并提前进行轨迹规划,本发明结合纯跟踪导引率和视线法导引率,完成回转运动使欠驱动AUV位于对接装置之后且运动同方向,使欠驱动AUV能快速地完成移动式对接回收任务。本发明计算简单,易于实现,且不依赖于精确的AUV模型,在不确定性外界环境干扰下具有较强的自适应性。

    基于有效节点筛选的AUV地形匹配定位方法

    公开(公告)号:CN107727096B

    公开(公告)日:2020-10-27

    申请号:CN201710833352.9

    申请日:2017-09-15

    Abstract: 本发明的目的在于提供基于有效节点筛选的AUV地形匹配定位方法,根据推算导航的输出结果确定搜索范围,再确定搜索范围后再利用测量地形数据与先验地形进行初步的匹配定位并获得匹配后的地形测量误差估计,然后分别计算节点的有效性和二次搜索范围,根据有效节点矩阵和二次搜索范围进行二次精确匹配定位,最后输出匹配定位结果。本发明所采用的初匹配与精细搜索匹配相结合的匹配定位方法有效的增加了搜索配准的效率同时提高定位精度。

Patent Agency Ranking