[发明专利]一种无人艇自主航行控制算法仿真评估系统

权利要求书

1.一种无人艇自主航行控制算法仿真评估系统，其特征在于，包括：

待测试的航行自主控制器，用于按照无人艇通信协议分别与无人艇运动学模型以及无人艇操控软件进行通信；所述无人艇操控软件为航迹跟踪算法、动态避障算法、目标跟踪算法在内的自主航行控制算法运行软件；

仿真模型建立模块，用于建立无人艇运动学模型和影响无人艇运动的环境模型；

所述无人艇运动学模型的模型输入为无人艇操控软件按照规定协议输出的期望航向及期望航速；无人艇运动学模型的模型输出为向航行自主控制器输出当前航速、航向、经纬度信息；

障碍目标仿真模块，用于根据障碍目标的经纬度、航速、航向、大小、障碍类型，模拟无人艇感知系统输出的障碍目标报文；

自主航行控制算法评估模块，用于根据无人艇自主航行控制任务对自主航行控制算法进行评估；所述无人艇自主航行控制任务包括航迹跟踪、动态避障及目标跟踪任务。

2.根据权利要求1所述的无人艇自主航行控制算法仿真评估系统，其特征在于，所述自主航行控制算法评估模块包括：

航迹跟踪算法评估子模块，用于根据每个控制周期T获取一次规划航迹数据、模拟障碍目标数据和无人艇状态数据对航迹跟踪算法进行评估；

评估值的计算方式为：

其中，m₁为从起始点至终点设置的观测点个数；u_n为第n个观测点处无人艇实际位置与规划位置的偏差；u_max为整段航迹中的最大偏差值；Δt为从起始点至终点的总耗时；S为从起始点至终点的总长度；σ₁，σ₂，σ₃为加权比例系数，其中σ₁+σ₂+σ₃＝1并且0≤σ₁，σ₂，σ₃≤1；

动态避障算法评估子模块，用于根据每个控制周期T获取一次规划航迹数据、模拟障碍目标数据和无人艇状态数据对航迹跟踪算法进行评估；

评估值的计算方式为：

其中，m₂为从起始点至终点的模拟障碍目标数量；g_n为本艇距离第n个模拟障碍目标的距离；r为避障半径；g_min为整段避障中的距离模拟障碍最近距离；Δt为从起始点至终点的总耗时；S为从起始点至终点的总长度；σ₄，σ₅，σ₆为加权比例，其中σ₄+σ₅+σ₆＝1并且0≤σ₄，σ₅，σ₆≤1；

目标跟踪算法评估子模块，用于根据每个控制周期T获取一次规划航迹数据、模拟障碍目标数据和无人艇状态数据对目标跟踪算法进行评估；

评估值的计算方式为：

其中，m₃为从稳定跟踪后，无人艇脱离跟踪区域的次数；t_n为第n次偏离跟踪区域的时间；Δt_l为稳定跟踪后到结束状态所花时间；Δt_s为从发现目标到第一次稳定跟踪状态所花事假；σ₇，σ₈为加权比例，其中σ₇+σ₈＝1并且0≤σ₇，σ₈≤1。

3.根据权利要求1所述的无人艇自主航行控制算法仿真评估系统，其特征在于，所述无人艇运动的环境模型为环境干扰量对无人艇产生的运动干扰；

定义无人艇受到的环境干扰力矩τ_d，

τ_d＝τ_wi+τ_str+τ_wa

式中，τ_wi、τ_str、τ_wa分别代表着风、浪、流对无人艇的干扰转矩。