一种基于虚拟膨化的运动障碍与UUV相向航行的规避方法

摘要

一种基于虚拟膨化的运动目标与UUV相向航行的规避方法，本发明涉及基于虚拟膨化的运动目标与UUV相向航行的规避方法。本发明是为了目前采用的相向航行的运动障碍规避方法难以准确预测运动障碍的运动状态的问题。本发明根据运动障碍航向与引导航向的夹角为headAngle，确定UUV与运动障碍相向航行，当UUV检测到与运动障碍物相向航行时，运动障碍进行圆形膨化后生成矩形虚拟障碍，计算触发航路规划算法的衡量距离nextL，当UUV与运动障碍中心点的直线距离M满足M<nextL时触发航路规划算法，计算下一次触发规划的衡量距nextL，直到航路规划算法不再被触发。本发明应用于UUV的运动障碍规避领域。

主权项

一种基于虚拟膨化的运动障碍与UUV相向航行的规避方法，其特征在于，所述基于虚拟膨化的运动障碍与UUV相向航行的规避方法包括以下步骤：步骤一：设运动障碍航向与引导航向的夹角为headAngle，当时，UUV与运动障碍为相向航行；所述引导航向是指从UUV当前位置到下一个非运动障碍航路点的连线所形成的向量，非运动障碍航路点是指不是依托于运动障碍形成的环境中静态环境信息的顶点；步骤二：当UUV检测到与运动障碍物相向航行时，运动障碍进行圆形膨化；步骤三：根据步骤二中运动障碍的圆形膨化，生成矩形虚拟障碍；步骤四：根据步骤二和步骤三，计算触发航路规划算法的衡量距离nextL，当UUV与运动障碍中心点的直线距离M满足M<nextL时触发航路规划算法，计算下一次触发规划的衡量距nextL，直到nextL＝abs_r+safe_d时，航路规划算法不再被触发；其中所述obs_r为运动障碍半径，safe_d为膨化距离。