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

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


背景技术：

2.障碍物目标定位、避障航路规划是无人艇高速、安全自主航行的重要保障。当无人艇在水域内航行时，主要是利用导航雷达对航路周边情况进行探测，获取有碍于航行的目标情况。但由于海杂波、周边电磁场变化等的影响，会出现大量虚假目标回波、真实目标没有回波、回波形状变化大等问题，所以仅采用导航雷达进行感知，是不足以保障无人艇准确获取周边目标情况，需要采用光电等光学感知手段进行确认、综合定位障碍物目标，但光学手段也存在检测、识别的概率问题。
3.在定位障碍物目标后，通过估算与障碍物目标发生碰撞的危险度，规划无人艇避开各种危险的实时航路。为了支撑快速避障航路规划，一般采用欧几里得符号距离场(euclidean signed distance field，esdf)方法构建环境的预知地图，即将无人艇航行区域进行栅格化，对每个栅格计算与障碍物目标的最近距离，形成欧几里得符号距离场。然后根据欧几里得符号距离场，利用采样或启发式搜索等方法，在地图中查找能够避开障碍物目标、满足无人艇运动学要求的航路点，形成避障航路。
4.现有技术存在的主要问题是：
5.(1)对导航雷达、光电探测的目标位置采用确定性的描述方法，没有反应雷达、光电感知存在的不确定性；
6.(2)欧几里得符号距离场是以当前探测的障碍物目标位置为基础计算的，一般是将运动目标当作静态目标来计算，容易导致规划的航路出现急转、急停等情况；
7.(3)有的方法仅简单将目标进行外推，没有反应感知目标的不确定性和目标航速航向的不稳定性，容易导致艇在一定范围内打转。


技术实现要素：

8.本发明的目的在于针对现有技术存在的问题，提供一种基于导航雷达和光电的无人艇概率距离地图构建方法，通过将导航雷达、光电感知的不确定性转化为目标的存在概率函数，然后以此存在概率函数为基础外推计算目标在地图上存在的距离场，为无人艇规划安全、平稳的避障航路提供保障。
9.实现本发明目的的技术解决方案为：一种基于导航雷达和光电的无人艇概率距离地图构建方法，所述方法包括以下步骤：
10.步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；
11.步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；
12.步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；
13.步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；
14.步骤5，计算各预测时刻的概率距离地图。
15.进一步地，步骤1中对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点，具体过程包括：
16.定义：设无人艇导航雷达在tk时刻的回波集合为其中为正整数；为正整数，表示回波点的个数；为正整数，表示回波点的个数；为正整数，表示回波点的个数；表示回波点的x轴位置信息，表示回波点的y轴位置信息，表示回波点的回波强度信息，为以无人艇起点为原点的大地坐标系下量测值；设在t
k-1
时刻，已形成了目标航迹集合刻，已形成了目标航迹集合其中为目标航迹个数，trackm在t
k-1
时刻的值表示为即[x位置，y位置，x速度，y速度，回波平均强度]；
[0017]
步骤1-1，根据预定的距离门限r，划分为聚类后回波点集合1，根据预定的距离门限r，划分为聚类后回波点集合1，根据预定的距离门限r，划分为聚类后回波点集合是的子集，满足以下要求:
[0018][0019]
且且且
[0020]
步骤1-2，对于每个通过平均每个点计算得到其中心点
[0021]
进一步地，步骤2中对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前tk时刻相对目标航迹的存在概率，具体过程包括：
[0022]
步骤2-1，计算聚类后回波点集合中的每个回波点集合相对于目标航迹trackm的模糊隶属度
[0023][0024]
[0025][0026]
其中，为目标航迹trackm在t
k-1
时刻的数值，为目标航迹trackm在tk时刻的预测值，为tk时刻的状态转移矩阵，计算更新过程采用传统卡尔曼滤波，τs和σs是对应于第s项的常数，表示该项的展度；
[0027]
步骤2-2，计算聚类后回波点集合的综合相似度矩阵
[0028][0029][0030]
其中，as为常数系数，表示各项的重要程度；
[0031]
步骤2-3，计算tk时刻回波点集合相对于目标航迹trackm的存在概率其中表示为杂波的概率：
[0032][0033][0034]
其中，b为常数，表示当前的杂波密度。
[0035]
进一步地，步骤3中采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率，具体过程包括：
[0036]
步骤3-1，对聚类后回波点集合中所有的回波点集合按照大小顺序进行降序排列；
[0037]
步骤3-2，按步骤3-1的次序逐一调度光电进行确认：即将光电视场中心调度指向且光电的视场角调整为回波点集合舷角宽度的三倍；
[0038]
步骤3-3，根据光电探测的视频识别结果，判断当前回波点集合是否存在真实目标，视频识别结果已确认存在目标，计算存在概率具体为：
[0039]
若
[0040][0041][0042][0043]
否则：
[0044]
[0045][0046]
其中，p
identy
为预置的光电识别成功率，count为成功识别的次数，p
newtrack
为预置的新目标航迹概率阈值；
[0047]
步骤3-4，根据光电探测的视频识别结果，判断视频识别结果无目标，计算存在概率为：
[0048][0049][0050]
步骤3-5，对所有的回波处理确认完成后，更新目标航迹集合和对应的存在概率：
[0051]
若
[0052][0053]
在中删除第m个目标航迹
[0054][0055]
其中，p
deltrack
为预置的目标航迹删除概率阈值。
[0056]
进一步地，步骤4中根据当前时刻tk各目标航迹位置和存在概率，递推预测时间t
k+l
各目标航迹位置及存在概率，l≥1，具体过程包括：
[0057]
步骤4-1，对每个中所有回波的递推时刻t
k+l
的位置，得到预测的回波位置集合
[0058][0059][0060]
其中，
[0061]
1≤l≤l
[0062][0063]
分别为回波点的x轴位置信息、y轴位置信息以及回波强度信息；
[0064]
步骤4-2，计算在时刻t
k+l
每个的存在概率和
[0065][0066][0067]
进一步地，步骤5中计算时刻t
k+l
的概率距离地图，具体过程包括：
[0068]
步骤5-1，将地图按照预定的栅格大小进行栅格化，形成栅格集合sg＝{sgh|1≤h≤h}，h为栅格数量，sgh为第h个栅格，sgh＝[sgxh,sgyh]，sgxh、sgyh分别为第h个栅格的x轴
位置信息和y轴位置信息；
[0069]
步骤5-2，计算每个栅格sgh在t
k+l
时刻相对所有的距离其中1≤l≤l：
[0070][0071]
本发明与现有技术相比，其显著优点为：
[0072]
(1)本发明在当前探测的回波信息基础上，通过光电确认和历史信息积累，保障目标航迹和距离地图的相对稳定。
[0073]
(2)本发明将导航雷达、光电探测的不确定性考虑到距离地图构建中，支撑实现稳定避障航路规划。
[0074]
(3)本发明将目标存在概率加入到目标航迹递推预测中，能够实现有动态目标情况下距离地图的构建，支撑高效地规避动态目标。
[0075]
下面结合附图对本发明作进一步详细描述。
附图说明
[0076]
图1为基于导航雷达和光电的无人艇概率距离地图构建方法的流程示意图。
具体实施方式
[0077]
为了使本技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本技术进行进一步详细说明。应当理解，此处描述的具体实施例仅仅用以解释本技术，并不用于限定本技术。
[0078]
需要说明，若本发明实施例中有涉及方向性指示(诸如上、下、左、右、前、后
……
)，则该方向性指示仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等，如果该特定姿态发生改变时，则该方向性指示也相应地随之改变。
[0079]
另外，若本发明实施例中有涉及“第一”、“第二”等的描述，则该“第一”、“第二”等的描述仅用于描述目的，而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外，各个实施例之间的技术方案可以相互结合，但是必须是以本领域普通技术人员能够实现为基础，当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在，也不在本发明要求的保护范围之内。
[0080]
在一个实施例中，提供了一种基于导航雷达和光电的无人艇概率距离地图构建方法，所述方法包括以下步骤：
[0081]
步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；
[0082]
步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；
[0083]
步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；
[0084]
步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；
[0085]
步骤5，计算各预测时刻的概率距离地图。
[0086]
进一步地，在其中一个实施例中，步骤1中对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点，具体过程包括：
[0087]
定义：设无人艇导航雷达在tk时刻的回波集合为其中为正整数；为正整数，表示回波点的个数；为正整数，表示回波点的个数；为正整数，表示回波点的个数；表示回波点的x轴位置信息，表示回波点的y轴位置信息，表示回波点的回波强度信息，为以无人艇起点为原点的大地坐标系下量测值；设在t
k-1
时刻，已形成了目标航迹集合时刻，已形成了目标航迹集合其中为目标航迹个数，trackm在t
k-1
时刻的值表示为即[x位置，y位置，x速度，y速度，回波平均强度]；
[0088]
步骤1-1，根据预定的距离门限r，划分为聚类后回波点集合1，根据预定的距离门限r，划分为聚类后回波点集合1，根据预定的距离门限r，划分为聚类后回波点集合是的子集，满足以下要求:
[0089][0090]
且且且
[0091]
步骤1-2，对于每个通过平均每个点计算得到其中心点
[0092]
进一步地，在其中一个实施例中，步骤2中对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前tk时刻相对目标航迹的存在概率，具体过程包括：
[0093]
步骤2-1，计算聚类后回波点集合中的每个回波点集合相对于目标航迹trackm的模糊隶属度
[0094]
[0095][0096][0097]
其中，为目标航迹trackm在t
k-1
时刻的数值，为目标航迹trackm在tk时刻的预测值，为tk时刻的状态转移矩阵，计算更新过程采用传统卡尔曼滤波，τs和σs是对应于第s项的常数，表示该项的展度；
[0098]
步骤2-2，计算聚类后回波点集合的综合相似度矩阵
[0099][0100][0101]
其中，as为常数系数，表示各项的重要程度；
[0102]
步骤2-3，计算tk时刻回波点集合相对于目标航迹trackm的存在概率其中表示为杂波的概率：
[0103][0104][0105]
其中，b为常数，表示当前的杂波密度。
[0106]
进一步地，在其中一个实施例中，步骤3中采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率，具体过程包括：
[0107]
步骤3-1，对聚类后回波点集合中所有的回波点集合按照大小顺序进行降序排列；
[0108]
步骤3-2，按步骤3-1的次序逐一调度光电进行确认：即将光电视场中心调度指向且光电的视场角调整为回波点集合舷角宽度的三倍；
[0109]
步骤3-3，根据光电探测的视频识别结果，判断当前回波点集合是否存在真实目标，视频识别结果已确认存在目标，计算存在概率具体为：
[0110]
若
[0111][0112][0113][0114]
否则：
[0115][0116][0117]
其中，p
identy
为预置的光电识别成功率，count为成功识别的次数，p
newtrack
为预置的新目标航迹概率阈值；
[0118]
步骤3-4，根据光电探测的视频识别结果，判断视频识别结果无目标，计算存在概率为：
[0119][0120][0121]
步骤3-5，对所有的回波处理确认完成后，更新目标航迹集合和对应的存在概率：
[0122]
若
[0123][0124]
在中删除第m个目标航迹
[0125][0126]
其中，p
deltrack
为预置的目标航迹删除概率阈值。
[0127]
进一步地，在其中一个实施例中，步骤4中根据当前时刻tk各目标航迹位置和存在概率，递推预测时间t
k+l
各目标航迹位置及存在概率，l≥1，具体过程包括：
[0128]
步骤4-1，对每个中所有回波的递推时刻t
k+l
的位置，得到预测的回波位置集合
[0129][0130][0131]
其中，
[0132]
1≤l≤l
[0133][0134]
分别为回波点的x轴位置信息、y轴位置信息以及回波强度信息；
[0135]
步骤4-2，计算在时刻t
k+l
每个的存在概率和
[0136][0137][0138]
进一步地，在其中一个实施例中，步骤5中计算时刻t
k+l
的概率距离地图，具体过程包括：
[0139]
步骤5-1，将地图按照预定的栅格大小进行栅格化，形成栅格集合sg＝{sgh|1≤h≤h}，h为栅格数量，sgh为第h个栅格，sgh＝[sgxh,sgyh]，sgxh、sgyh分别为第h个栅格的x轴位置信息和y轴位置信息；
[0140]
步骤5-2，计算每个栅格sgh在tk
+l
时刻相对所有的距离其中1≤l≤l：
[0141][0142]
在一个实施例中，提供了一种基于导航雷达和光电的无人艇概率距离地图构建系统，所述系统包括：
[0143]
第一模块，用于对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；
[0144]
第二模块，用于对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；
[0145]
第三模块，用于采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；
[0146]
第四模块，用于根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；
[0147]
第五模块，用于计算各预测时刻的概率距离地图。
[0148]
关于基于导航雷达和光电的无人艇概率距离地图构建系统的具体限定可以参见上文中对于基于导航雷达和光电的无人艇概率距离地图构建方法的限定，在此不再赘述。上述基于导航雷达和光电的无人艇概率距离地图构建系统中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中，也可以以软件形式存储于计算机设备中的存储器中，以便于处理器调用执行以上各个模块对应的操作。
[0149]
在一个实施例中，提供了一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，处理器执行计算机程序时实现以下步骤：
[0150]
步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；
[0151]
步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当
前时刻相对目标航迹的存在概率；
[0152]
步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；
[0153]
步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；
[0154]
步骤5，计算各预测时刻的概率距离地图。
[0155]
关于每一步的具体限定可以参见上文中对于基于导航雷达和光电的无人艇概率距离地图构建方法的限定，在此不再赘述。
[0156]
在一个实施例中，提供了一种计算机可读存储介质，其上存储有计算机程序，计算机程序被处理器执行时实现以下步骤：
[0157]
步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；
[0158]
步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；
[0159]
步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；
[0160]
步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；
[0161]
步骤5，计算各预测时刻的概率距离地图。
[0162]
关于每一步的具体限定可以参见上文中对于基于导航雷达和光电的无人艇概率距离地图构建方法的限定，在此不再赘述。
[0163]
本发明针对无人艇自主航行中障碍物目标感知、避障航路规划的需求，在当前探测的回波信息基础上，通过光电确认和历史信息积累，保障目标航迹和距离地图的相对稳定，将目标存在概率加入到目标航迹递推预测中，能够实现有动态目标情况下距离地图的构建，支撑高效地规避动态目标，实现稳定避障航路规划。
[0164]
以上显示和描述了本发明的基本原理、主要特征及优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的只是说明本发明的原理，在不脱离本发明精神和范围的前提下，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

技术特征：
1.一种基于导航雷达和光电的无人艇概率距离地图构建方法，其特征在于，所述方法包括以下步骤：步骤1，对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；步骤2，对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；步骤3，采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；步骤4，根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；步骤5，计算各预测时刻的概率距离地图。2.根据权利要求1所述的基于导航雷达和光电的无人艇概率距离地图构建方法，其特征在于，步骤1中对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点，具体过程包括：定义：设无人艇导航雷达在t
k
时刻的回波集合为其中为正整数；为正整数，表示回波点的个数；为正整数，表示回波点的个数；为正整数，表示回波点的个数；表示回波点的x轴位置信息，表示回波点的y轴位置信息，表示回波点的回波强度信息，为以无人艇起点为原点的大地坐标系下量测值；设在t
k-1
时刻，已形成了目标航迹集合刻，已形成了目标航迹集合其中为目标航迹个数，track
m
在t
k-1
时刻的值表示为即x位置，y位置，x速度，y速度，回波平均强度]；步骤1-1，根据预定的距离门限r，划分为聚类后回波点集合1，根据预定的距离门限r，划分为聚类后回波点集合1，根据预定的距离门限r，划分为聚类后回波点集合是的子集，满足以下要求:求:且且且步骤1-2，对于每个通过平均每个点计算得到其中心点3.根据权利要求2所述的基于导航雷达和光电的无人艇概率距离地图构建方法，其特征在于，步骤2中对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前t
k
时刻相对目标航迹的存在概率，具体过程包括：步骤2-1，计算聚类后回波点集合中的每个回波点集合相对于目标
航迹track
m
的模糊隶属度的模糊隶属度的模糊隶属度的模糊隶属度其中，为目标航迹track
m
在t
k-1
时刻的数值，为目标航迹track
m
在t
k
时刻的预测值，为t
k
时刻的状态转移矩阵，计算更新过程采用传统卡尔曼滤波，τ
s
和σ
s
是对应于第s项的常数，表示该项的展度；步骤2-2，计算聚类后回波点集合的综合相似度矩阵的综合相似度矩阵的综合相似度矩阵其中，a
s
为常数系数，表示各项的重要程度；步骤2-3，计算t
k
时刻回波点集合相对于目标航迹track
m
的存在概率其中表示为杂波的概率：表示为杂波的概率：其中，b为常数，表示当前的杂波密度。4.根据权利要求3所述的基于导航雷达和光电的无人艇概率距离地图构建方法，其特征在于，步骤3中采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率，具体过程包括：步骤3-1，对聚类后回波点集合中所有的回波点集合按照大小顺序进行降序排列；步骤3-2，按步骤3-1的次序逐一调度光电进行确认：即将光电视场中心调度指向且光电的视场角调整为回波点集合舷角宽度的三倍；
步骤3-3，根据光电探测的视频识别结果，判断当前回波点集合是否存在真实目标，视频识别结果已确认存在目标，计算存在概率具体为：若若若若否则：否则：其中，p
identy
为预置的光电识别成功率，count为成功识别的次数，p
newtrack
为预置的新目标航迹概率阈值；步骤3-4，根据光电探测的视频识别结果，判断视频识别结果无目标，计算存在概率为：4，根据光电探测的视频识别结果，判断视频识别结果无目标，计算存在概率为：步骤3-5，对所有的回波处理确认完成后，更新目标航迹集合和对应的存在概率：若若在中删除第m个目标航迹其中，p
deltrack
为预置的目标航迹删除概率阈值。5.根据权利要求4所述的基于导航雷达和光电的无人艇概率距离地图构建方法，其特征在于，步骤4中根据当前时刻t
k
各目标航迹位置和存在概率，递推预测时间t
k+l
各目标航迹位置及存在概率，l≥1，具体过程包括：步骤4-1，对每个中所有回波的递推时刻t
k+l
的位置，得到预测的回波位置集合集合集合其中，1≤l≤l
分别为回波点的x轴位置信息、y轴位置信息以及回波强度信息；步骤4-2，计算在时刻t
k+l
每个的存在概率和和和6.根据权利要求5所述的基于导航雷达和光电的无人艇概率距离地图构建方法，其特征在于，步骤5中计算时刻t
k+l
的概率距离地图，具体过程包括：步骤5-1，将地图按照预定的栅格大小进行栅格化，形成栅格集合sg＝{sg
h
|1≤h≤h}，h为栅格数量，sg
h
为第h个栅格，sg
h
＝[sgx
h
,sgy
h
]，sgx
h
、sgy
h
分别为第h个栅格的x轴位置信息和y轴位置信息；步骤5-2，计算每个栅格sg
h
在t
k+l
时刻相对所有的距离distance
h,tk+l
，其中1≤l≤l：7.基于权利要求1至6任意一项所述方法的基于导航雷达和光电的无人艇概率距离地图构建系统，其特征在于，所述系统包括：第一模块，用于对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；第二模块，用于对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；第三模块，用于采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；第四模块，用于根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；第五模块，用于计算各预测时刻的概率距离地图。8.一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述计算机程序时实现权利要求1至6中任一项所述方法的步骤。9.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，所述计算机程序被处理器执行时实现权利要求1至6中任一项所述方法的步骤。

技术总结
本发明公开了一种基于导航雷达和光电的无人艇概率距离地图构建方法，包括步骤：对无人艇导航雷达回波点进行聚类处理，计算聚类后各回波集合的中心点；对聚类后回波集合采用模糊关联判断，计算与目标航迹的相关性，得到当前时刻相对目标航迹的存在概率；采用基于存在概率的调度策略，调度无人艇光电对聚类后回波集合进行确认，更新存在概率；根据当前时刻各目标航迹位置和存在概率，递推预测时间各目标航迹位置及存在概率；计算各预测时刻的概率距离地图。本发明通过把导航雷达、光电感知的不确定性转化为目标的存在概率函数，然后以此存在概率函数为基础外推计算目标在地图上存在的距离场，为无人艇规划安全、平稳的避障航路提供保障。提供保障。提供保障。


技术研发人员：蔡庆 朱磊 高峰端 郑金华 梁立 袁文亮
受保护的技术使用者：连云港杰瑞科创园管理有限公司
技术研发日：2023.04.07
技术公布日：2023/7/21