无人水下航行器IVFH避碰方法

摘要

无人水下航行器IVFH避碰方法，涉及一种无人水下航行器的避碰方法。本发明提出一种无人水下航行器二维IVFH避碰方法，使无人水下航行器在航行过程中通过处理传感器数据获得障碍物位置信息后，能够着眼于安全性和快速性，使无人水下航行器具有一定的类人智能，综合障碍物距离、目标点距离、自由栅格百分比和已知视域百分比等因素，决策出合理的避碰动作，即：确定航向、航速指令，以规避障碍物，避免危险。本发明适用于无人水下航行器的避碰场合。

主权项

无人水下航行器IVFH避碰方法，其特征是：它包括以下步骤：步骤一、根据障碍物距离、目标点距离、自由栅格百分比和已知视域百分比进行环境态势评估；步骤二、综合各项归一化的环境态势指标，应用模糊推理，确定避碰航速以及避碰动作幅度，其中，避碰动作幅度体现为单障碍物对各个候选航向安全因子计算公式中的安全系数；步骤三、计算各个候选航向的安全因子和快捷因子；步骤四、计算各个候选航向的适应度及行进代价，根据行进代价评选最佳航向作为下一时刻航向指令；步骤五、输出航向指令和航速指令，驱动无人水下航行器航行。