[发明专利]一种航迹确定方法、装置及电子设备

说明书

本发明实施例提供了一种航迹确定方法、装置及电子设备，上述方法包括：获得雷达每隔预设雷达探测周期探测到的雷达量测数据，以及视觉传感器每隔预设视觉探测周期探测到的视觉量测数据；确定每个第一探测目标对应的雷达航迹；以及确定每个第二探测目标对应的视觉航迹；将雷达航迹中每个第一探测目标的第一位置坐标与视觉航迹中每个第二探测目标的第二位置坐标转换至同一坐标系；以及，对雷达航迹和/或视觉航迹进行航迹点补偿，使得雷达航迹中航迹点的探测时刻和视觉航迹中航迹点的探测时刻相同；将雷达航迹和所述视觉航迹中，探测时刻相同的航迹点进行融合，得到融合航迹。采用上述方法，扩展了目标探测的应用场景，提高了探测精度。

技术领域

本发明涉及汽车道路探测技术领域，特别是涉及一种航迹确定方法、装置及电子设备。

背景技术

ADAS(高级驾驶辅助系统)是通过安装在汽车上的各式各样的传感器，在汽车行驶过程中随时来感应周围的环境，收集数据，进行静态、动态目标的辨识、侦测与追踪，并结合导航仪地图数据，进行运算与分析的一种系统。在ADAS中，目标的探测识别是主要包括两种方式：通过摄像头视觉传感器探测识别目标和通过毫米波雷达探测识别目标。具体的，可以通过摄像头视觉传感器或通过毫米波雷达探测目标的位置，通过所探测的目标的位置计算出汽车相对目标的运动航迹，确定出目标相对汽车的相对位置，同时根据所探测的目标的影像数据，识别出目标。

然而通过摄像头视觉传感器探测识别目标和通过毫米波雷达探测识别目标的方式均具有一定的局限性：毫米波雷达对目标的横向参数探测迟钝，无法分辨车道线、交通标志等元素；视觉传感器探测距离近，测距、测速精度低，受光照、天气等因素影响大。因此，仅通过摄像头视觉传感器或仅通过毫米波雷达进行目标探测识别的应用场景受限较多，探测精度较低。

发明内容

本发明实施例的目的在于提供一种航迹确定方法、装置及电子设备，通过对雷达传感器探测的雷达航迹与视觉传感器探测的视觉航迹进行融合，以实现扩展目标探测的应用场景和提高目标探测的精度。

为了实现上述发明目的，本发明实施例提供了一种航迹确定方法，包括：

获得雷达每隔预设雷达探测周期探测到的雷达量测数据，以及视觉传感器每隔预设视觉探测周期探测到的视觉量测数据；所述雷达量测数据中包括雷达探测到的每个第一探测目标在雷达坐标系的第一位置坐标、第一运动速度以及第一被探测时刻，其中，第一被探测时刻为第一探测目标被雷达探测到的时刻；所述视觉量测数据中包括视觉传感器探测到的每个第二探测目标在视觉传感器坐标系的第二位置坐标、第二运动速度以及第二被探测时刻，其中，第二被探测时刻为第二探测目标被到的时刻；

基于雷达量测数据，确定每个第一探测目标对应的雷达航迹，所述雷达航迹中的每个雷达航迹点包括：对应的第一探测目标的第一位置坐标、第一运动速度以及第一被探测时刻；以及，基于视觉量测数据，确定每个第二探测目标对应的视觉航迹，所述视觉航迹中的每个视觉航迹点包括：对应的第二探测目标的第二位置坐标、第二运动速度以及第二被探测时刻；

将雷达航迹中每个第一探测目标的第一位置坐标与视觉航迹中每个第二探测目标的第二位置坐标转换至同一坐标系；以及，基于所述预设雷达探测周期和预设视觉探测周期、雷达航迹中每个第一探测目标的第一被探测时刻和视觉航迹中每个第二探测目标的第二被探测时刻、雷达航迹中每个第一探测目标的第一运动速度和视觉航迹中每个第二探测目标的第二运动速度，对雷达航迹和/或视觉航迹进行航迹点补偿，使得雷达航迹中航迹点的探测时刻和视觉航迹中航迹点的探测时刻相同；

将所述雷达航迹和所述视觉航迹中，探测时刻相同的航迹点进行融合，得到融合航迹。

进一步的，所述基于雷达量测数据，确定每个第一探测目标对应的雷达航迹，包括：

针对雷达量测数据中第一被探测时刻与预设融合时段的起始时刻最相近的各个雷达航迹点，分别创建一个雷达航迹列表，得到一个或多个雷达航迹列表；