一种无人艇自主航行控制算法仿真评估系统的制作方法

技术特征：
1.一种无人艇自主航行控制算法仿真评估系统，其特征在于，包括：待测试的航行自主控制器，用于按照无人艇通信协议分别与无人艇运动学模型以及无人艇操控软件进行通信；所述无人艇操控软件为航迹跟踪算法、动态避障算法、目标跟踪算法在内的自主航行控制算法运行软件；仿真模型建立模块，用于建立无人艇运动学模型和影响无人艇运动的环境模型；所述无人艇运动学模型的模型输入为无人艇操控软件按照规定协议输出的期望航向及期望航速；无人艇运动学模型的模型输出为向航行自主控制器输出当前航速、航向、经纬度信息；障碍目标仿真模块，用于根据障碍目标的经纬度、航速、航向、大小、障碍类型，模拟无人艇感知系统输出的障碍目标报文；自主航行控制算法评估模块，用于根据无人艇自主航行控制任务对自主航行控制算法进行评估；所述无人艇自主航行控制任务包括航迹跟踪、动态避障及目标跟踪任务。2.根据权利要求1所述的无人艇自主航行控制算法仿真评估系统，其特征在于，所述自主航行控制算法评估模块包括：航迹跟踪算法评估子模块，用于根据每个控制周期t获取一次规划航迹数据、模拟障碍目标数据和无人艇状态数据对航迹跟踪算法进行评估；评估值的计算方式为：其中，m1为从起始点至终点设置的观测点个数；u
n
为第n个观测点处无人艇实际位置与规划位置的偏差；u
max
为整段航迹中的最大偏差值；δt为从起始点至终点的总耗时；s为从起始点至终点的总长度；σ1，σ2，σ3为加权比例系数，其中σ1 σ2 σ3＝1并且0≤σ1，σ2，σ3≤1；动态避障算法评估子模块，用于根据每个控制周期t获取一次规划航迹数据、模拟障碍目标数据和无人艇状态数据对航迹跟踪算法进行评估；评估值的计算方式为：其中，m2为从起始点至终点的模拟障碍目标数量；g
n
为本艇距离第n个模拟障碍目标的距离；r为避障半径；g
min
为整段避障中的距离模拟障碍最近距离；δt为从起始点至终点的总耗时；s为从起始点至终点的总长度；σ4，σ5，σ6为加权比例，其中σ4 σ5 σ6＝1并且0≤σ4，σ5，σ6≤1；目标跟踪算法评估子模块，用于根据每个控制周期t获取一次规划航迹数据、模拟障碍目标数据和无人艇状态数据对目标跟踪算法进行评估；评估值的计算方式为：
其中，m3为从稳定跟踪后，无人艇脱离跟踪区域的次数；t
n
为第n次偏离跟踪区域的时间；δt
l
为稳定跟踪后到结束状态所花时间；δt
s
为从发现目标到第一次稳定跟踪状态所花事假；σ7，σ8为加权比例，其中σ7 σ8＝1并且0≤σ7，σ8≤1。3.根据权利要求1所述的无人艇自主航行控制算法仿真评估系统，其特征在于，所述无人艇运动的环境模型为环境干扰量对无人艇产生的运动干扰；定义无人艇受到的环境干扰力矩τ
d
，τ
d
＝τ
wi
τ
str
τ
wa
式中，τ
wi
、τ
str
、τ
wa
分别代表着风、浪、流对无人艇的干扰转矩。

技术总结
本发明公开了一种无人艇自主航行控制算法仿真评估系统，包括：待测试的航行自主控制器，用于按照无人艇通信协议分别与无人艇运动学模型以及无人艇操控软件进行通信；仿真模型建立模块，用于建立无人艇运动学模型和影响无人艇运动的环境模型；障碍目标仿真模块，用于根据障碍目标的经纬度、航速、航向、大小、障碍类型，模拟无人艇感知系统输出的障碍目标报文；自主航行控制算法评估模块，用于根据无人艇自主航行控制任务对自主航行控制算法进行评估。本发明通过建立无人艇本艇模型、环境模型、模拟目标模型，使无人艇自主航行控制器在没有实艇的状态下进行调试及评估；并且软件硬件定型后可直接用于实艇，加快无人艇软硬件开发迭代速度。发迭代速度。发迭代速度。


技术研发人员：张逸凡 闫红州 唐李军 岳林 刘凯
受保护的技术使用者：中国舰船研究设计中心
技术研发日：2021.08.19
技术公布日：2021/11/8