一种海底地形等深线辅助导航路径规划方法

    公开(公告)号:CN115542927B

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

    申请号:CN202211130058.9

    申请日:2022-09-16

    Abstract: 本发明公开了一种海底地形等深线辅助导航路径规划方法,属于水下地形辅助导航与定位领域。本发明通过研究等深线地形匹配特性,从等深线先验海图中提取等深线疏密及等深线平滑度作为海底地形适配性,并根据海底地形适配性完成地形适配区建模;采用双向RRT*进行全局路径规划,在随机树扩展中,根据所处位置的等深线法线方向进行随机树节点筛选;在计算花费中,将AUV所处位置的地形适配性作为奖励函数考虑在计算范围内,寻求最优的规划路径;最后对规划好的路径利用贝塞尔曲线进行优化,满足AUV实际航行中的性能。

    一种海底地形等深线辅助导航路径规划方法

    公开(公告)号:CN115542927A

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

    申请号:CN202211130058.9

    申请日:2022-09-16

    Abstract: 本发明公开了一种海底地形等深线辅助导航路径规划方法,属于水下地形辅助导航与定位领域。本发明通过研究等深线地形匹配特性,从等深线先验海图中提取等深线疏密及等深线平滑度作为海底地形适配性,并根据海底地形适配性完成地形适配区建模;采用双向RRT*进行全局路径规划,在随机树扩展中,根据所处位置的等深线法线方向进行随机树节点筛选;在计算花费中,将AUV所处位置的地形适配性作为奖励函数考虑在计算范围内,寻求最优的规划路径;最后对规划好的路径利用贝塞尔曲线进行优化,满足AUV实际航行中的性能。

    一种水下相机-IMU-深度计的空间联合标定方法

    公开(公告)号:CN115330852A

    公开(公告)日:2022-11-11

    申请号:CN202210884061.3

    申请日:2022-07-26

    Abstract: 本发明涉及一种水下相机‑IMU‑深度计的空间联合标定方法,通过传统视觉图像特征方法对相机初始化,获得相机位姿和路标点信息;利用规划运动激励获得深度计和IMU测量数据,同时通过视觉位姿变化的信息约束,对深度数据离群点剔除;采用多组有效的相邻帧间深度信息、视觉信息和IMU预积分信息,建立手眼标定方程组;对方程组进行优化求解,获得外参变换初值;将初值加入后端非线性优化,并通过空间变换关系求解外参。本发明考虑到深度计测量数据只发生在垂直方向,通过运动约束,建立伪手眼标定方程组,对外参进行非线性优化,克服了水下相机‑IMU‑深度计外参不易获得,手工机械测量误差大的问题,为水下多传感器融合SLAM提供了准确的相机‑IMU‑深度计外参变换信息。

Patent Agency Ranking