摘要
本发明涉及一种面向动态障碍环境的AUV三维路径规划方法,包括:设置三维状态空间,更新三维状态空间中动态障碍物的运动状态,基于运动状态,获取动态障碍物的未来运动状态;将三维状态空间的目标位置参数和未来运动状态输入路径规划模型,获取无人水下航行器的离散路径节点;路径规划模型利用训练集结合综合奖励函数训练获得;对离散路径节点进行路径连续化和平滑化处理,获取三维路径规划结果。本发明在路径长度、避障成功率及计算效率方面均展现出明显优势,有效解决了动态障碍环境中的三维路径规划问题。
技术关键词
三维路径规划方法
动态障碍物
节点
运动
无人水下航行器
协方差矩阵
样条
加速度
训练集
因子
噪声
坐标
预测误差
网络
曲线