基于导航雷达和光电的无人艇概率距离地图构建方法

技术领域

本发明属于无人艇的自主航行领域，特别是一种基于导航雷达和光电的无人艇概率距离地图构建方法。

背景技术

障碍物目标定位、避障航路规划是无人艇高速、安全自主航行的重要保障。当无人艇在水域内航行时，主要是利用导航雷达对航路周边情况进行探测，获取有碍于航行的目标情况。但由于海杂波、周边电磁场变化等的影响，会出现大量虚假目标回波、真实目标没有回波、回波形状变化大等问题，所以仅采用导航雷达进行感知，是不足以保障无人艇准确获取周边目标情况，需要采用光电等光学感知手段进行确认、综合定位障碍物目标，但光学手段也存在检测、识别的概率问题。

在定位障碍物目标后，通过估算与障碍物目标发生碰撞的危险度，规划无人艇避开各种危险的实时航路。为了支撑快速避障航路规划，一般采用欧几里得符号距离场(Euclidean Signed Distance Field，ESDF)方法构建环境的预知地图，即将无人艇航行区域进行栅格化，对每个栅格计算与障碍物目标的最近距离，形成欧几里得符号距离场。然后根据欧几里得符号距离场，利用采样或启发式搜索等方法，在地图中查找能够避开障碍物目标、满足无人艇运动学要求的航路点，形成避障航路。

现有技术存在的主要问题是：

(1)对导航雷达、光电探测的目标位置采用确定性的描述方法，没有反应雷达、光电感知存在的不确定性；

(2)欧几里得符号距离场是以当前探测的障碍物目标位置为基础计算的，一般是将运动目标当作静态目标来计算，容易导致规划的航路出现急转、急停等情况；

(3)有的方法仅简单将目标进行外推，没有反应感知目标的不确定性和目标航速航向的不稳定性，容易导致艇在一定范围内打转。

发明内容

本发明的目的在于针对现有技术存在的问题，提供一种基于导航雷达和光电的无人艇概率距离地图构建方法，通过将导航雷达、光电感知的不确定性转化为目标的存在概率函数，然后以此存在概率函数为基础外推计算目标在地图上存在的距离场，为无人艇规划安全、平稳的避障航路提供保障。

实现本发明目的的技术解决方案为：一种基于导航雷达和光电的无人艇概率距离地图构建方法，所述方法包括以下步骤：

步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；

步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；

步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；

步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；

步骤5，计算各预测时刻的概率距离地图。

进一步地，步骤1中对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点，具体过程包括：

定义：设无人艇导航雷达在t

步骤1-1，根据预定的距离门限R，划分为聚类后回波点集合

且/>

步骤1-2，对于每个

进一步地，步骤2中对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前t

步骤2-1，计算聚类后回波点集合

其中，

步骤2-2，计算聚类后回波点集合

其中，a

步骤2-3，计算t

其中，b为常数，表示当前的杂波密度。

进一步地，步骤3中采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率，具体过程包括：

步骤3-1，对聚类后回波点集合

步骤3-2，按步骤3-1的次序逐一调度光电进行确认：即将光电视场中心调度指向

步骤3-3，根据光电探测的视频识别结果，判断当前回波点集合是否存在真实目标，视频识别结果已确认存在目标，计算存在概率具体为：

若

否则：

其中，P

步骤3-4，根据光电探测的视频识别结果，判断视频识别结果无目标，计算存在概率为：

步骤3-5，对所有的回波处理确认完成后，更新目标航迹集合和对应的存在概率：

若

在

其中，P

进一步地，步骤4中根据当前时刻t

步骤4-1，对每个

其中，

1≤l≤L

分别为/>

步骤4-2，计算在时刻t

进一步地，步骤5中计算时刻t

步骤5-1，将地图按照预定的栅格大小进行栅格化，形成栅格集合SG＝{sg

步骤5-2，计算每个栅格sg

本发明与现有技术相比，其显著优点为：

(1)本发明在当前探测的回波信息基础上，通过光电确认和历史信息积累，保障目标航迹和距离地图的相对稳定。

(2)本发明将导航雷达、光电探测的不确定性考虑到距离地图构建中，支撑实现稳定避障航路规划。

(3)本发明将目标存在概率加入到目标航迹递推预测中，能够实现有动态目标情况下距离地图的构建，支撑高效地规避动态目标。

下面结合附图对本发明作进一步详细描述。

附图说明

图1为基于导航雷达和光电的无人艇概率距离地图构建方法的流程示意图。

具体实施方式

为了使本申请的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本申请进行进一步详细说明。应当理解，此处描述的具体实施例仅仅用以解释本申请，并不用于限定本申请。

需要说明，若本发明实施例中有涉及方向性指示(诸如上、下、左、右、前、后……)，则该方向性指示仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等，如果该特定姿态发生改变时，则该方向性指示也相应地随之改变。

另外，若本发明实施例中有涉及“第一”、“第二”等的描述，则该“第一”、“第二”等的描述仅用于描述目的，而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外，各个实施例之间的技术方案可以相互结合，但是必须是以本领域普通技术人员能够实现为基础，当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在，也不在本发明要求的保护范围之内。

在一个实施例中，提供了一种基于导航雷达和光电的无人艇概率距离地图构建方法，所述方法包括以下步骤：

步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；

步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；

步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；

步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；

步骤5，计算各预测时刻的概率距离地图。

进一步地，在其中一个实施例中，步骤1中对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点，具体过程包括：

定义：设无人艇导航雷达在t

步骤1-1，根据预定的距离门限R，划分为聚类后回波点集合

且/>

步骤1-2，对于每个

进一步地，在其中一个实施例中，步骤2中对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前t

步骤2-1，计算聚类后回波点集合

其中，

步骤2-2，计算聚类后回波点集合

其中，a

步骤2-3，计算t

其中，b为常数，表示当前的杂波密度。

进一步地，在其中一个实施例中，步骤3中采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率，具体过程包括：

步骤3-1，对聚类后回波点集合

步骤3-2，按步骤3-1的次序逐一调度光电进行确认：即将光电视场中心调度指向

步骤3-3，根据光电探测的视频识别结果，判断当前回波点集合是否存在真实目标，视频识别结果已确认存在目标，计算存在概率具体为：

若

否则：

其中，P

步骤3-4，根据光电探测的视频识别结果，判断视频识别结果无目标，计算存在概率为：

步骤3-5，对所有的回波处理确认完成后，更新目标航迹集合和对应的存在概率：

若

在

其中，P

进一步地，在其中一个实施例中，步骤4中根据当前时刻t

步骤4-1，对每个

其中，

1≤l≤L

分别为/>

步骤4-2，计算在时刻t

进一步地，在其中一个实施例中，步骤5中计算时刻t

步骤5-1，将地图按照预定的栅格大小进行栅格化，形成栅格集合SG＝{sg

步骤5-2，计算每个栅格sg

在一个实施例中，提供了一种基于导航雷达和光电的无人艇概率距离地图构建系统，所述系统包括：

第一模块，用于对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；

第二模块，用于对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；

第三模块，用于采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；

第四模块，用于根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；

第五模块，用于计算各预测时刻的概率距离地图。

关于基于导航雷达和光电的无人艇概率距离地图构建系统的具体限定可以参见上文中对于基于导航雷达和光电的无人艇概率距离地图构建方法的限定，在此不再赘述。上述基于导航雷达和光电的无人艇概率距离地图构建系统中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中，也可以以软件形式存储于计算机设备中的存储器中，以便于处理器调用执行以上各个模块对应的操作。

在一个实施例中，提供了一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，处理器执行计算机程序时实现以下步骤：

步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；

步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；

步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；

步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；

步骤5，计算各预测时刻的概率距离地图。

关于每一步的具体限定可以参见上文中对于基于导航雷达和光电的无人艇概率距离地图构建方法的限定，在此不再赘述。

在一个实施例中，提供了一种计算机可读存储介质，其上存储有计算机程序，计算机程序被处理器执行时实现以下步骤：

步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；

步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；

步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；

步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；

步骤5，计算各预测时刻的概率距离地图。

关于每一步的具体限定可以参见上文中对于基于导航雷达和光电的无人艇概率距离地图构建方法的限定，在此不再赘述。

本发明针对无人艇自主航行中障碍物目标感知、避障航路规划的需求，在当前探测的回波信息基础上，通过光电确认和历史信息积累，保障目标航迹和距离地图的相对稳定，将目标存在概率加入到目标航迹递推预测中，能够实现有动态目标情况下距离地图的构建，支撑高效地规避动态目标，实现稳定避障航路规划。

以上显示和描述了本发明的基本原理、主要特征及优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的只是说明本发明的原理，在不脱离本发明精神和范围的前提下，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。