[发明专利]一种基于单路口多传感器的航迹融合方法及系统

权利要求书

1.一种基于单路口多传感器的航迹融合方法，其特征在于，所述方法包括：

根据预置数据关联算法和当前帧各个目标点的雷达距离信息和相机距离信息，确定当前帧中匹配成功的目标点和匹配不成功的目标点；

若目标点为匹配成功的目标点，则根据雷达获取的所述目标点的距离信息、速度信息、标号信息，以及相机获取的所述匹配成功的目标点的距离信息、标号信息、类别信息，生成所述匹配成功的目标点对应的航迹信息；

若目标点为匹配不成功的目标点，获取所述目标点对应的传感器类型；

若所述目标点为雷达目标点，则根据雷达获取的所述目标点的信息生成所述目标点对应的航迹信息；

若所述目标点为相机目标点，则根据相机获取的所述目标点的信息生成所述目标点对应的航迹信息。

2.根据权利要求1所述的一种基于单路口多传感器的航迹融合方法，其特征在于，所述根据预置数据关联算法和当前帧各个目标点的雷达距离信息和相机距离信息，确定当前帧中匹配成功的目标点和匹配不成功的目标点的步骤包括：

根据公式计算关联矩阵C，其中，i是雷达获取的目标点序号，j是相机获取的目标点序号，c_i,j＝1/D_i,j，D_i,j是根据雷达和相机的距离d_i,j和门限值gate得到的；

根据关联矩阵C和KM算法确定当前帧中匹配成功的目标点和匹配不成功的目标点。

3.根据权利要求1所述的一种基于单路口多传感器的航迹融合方法，其特征在于，所述若目标点为匹配成功的目标点，则根据雷达获取的所述目标点的距离信息、速度信息、标号信息，以及相机获取的所述匹配成功的目标点的距离信息、标号信息、类别信息，生成所述匹配成功的目标点对应的航迹信息的步骤包括：

根据公式生成所述匹配成功的目标点对应的航迹信息，其中，融合后的目标点的距离分别为X_t、Y_t、速度为V_t、标号为n_t、匹配标号为n_match、类别Class，x_r和y_r为雷达获取的所述目标点的距离，V_r为雷达获取的所述目标点的速度，n_r为雷达获取的所述目标点的标号，n_c为相机获取的所述目标点的标号，class为相机获取的所述目标点的类别。

4.根据权利要求1所述的一种基于单路口多传感器的航迹融合方法，其特征在于，所述若目标点为匹配成功的目标点，则根据雷达获取的所述目标点的距离信息、速度信息、标号信息，以及相机获取的所述匹配成功的目标点的距离信息、标号信息、类别信息，生成所述匹配成功的目标点对应的航迹信息的步骤包括：

根据雷达在x、y方向的测量平均误差，相机在x、y方向的测量平均误差，雷达获取的所述目标点的距离，相机获取的所述目标点的距离，获取融合后的目标点的距离，根据雷达获取的所述目标点的速度获取融合后的目标点的速度，根据雷达获取的所述目标点的标号获取融合后的目标点的标号，根据相机获取的所述目标点的标号获取融合后的目标点的匹配标号，根据相机获取的所述目标点的类别获取融合后的目标点的类别。

5.根据权利要求1所述的一种基于单路口多传感器的航迹融合方法，其特征在于，所述若所述目标点为匹配不成功的目标点且为雷达目标点，则根据雷达获取的所述目标点的信息生成所述目标点对应的航迹信息的步骤包括：

根据公式生成所述目标点对应的航迹信息，其中，融合后的目标点的距离分别为X_t、Y_t、速度为V_t、标号为n_t、匹配标号为n_match、类别Class，x_r和y_r为雷达获取的所述目标点的距离，V_r为雷达获取的所述目标点的速度，n_r为雷达获取的所述目标点的标号，n_c为相机获取的所述目标点的标号，class为相机获取的所述目标点的类别。