CN114488065A - 一种航迹数据处理方法、装置、车辆和介质 - Google Patents

一种航迹数据处理方法、装置、车辆和介质 Download PDF

Info

Publication number
CN114488065A
CN114488065A CN202210101307.5A CN202210101307A CN114488065A CN 114488065 A CN114488065 A CN 114488065A CN 202210101307 A CN202210101307 A CN 202210101307A CN 114488065 A CN114488065 A CN 114488065A
Authority
CN
China
Prior art keywords
obstacle
current
track data
historical
vehicle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202210101307.5A
Other languages
English (en)
Inventor
白天晟
吕颖
祁旭
曲白雪
祝铭含
杨航
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
FAW Group Corp
Original Assignee
FAW Group Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by FAW Group Corp filed Critical FAW Group Corp
Priority to CN202210101307.5A priority Critical patent/CN114488065A/zh
Publication of CN114488065A publication Critical patent/CN114488065A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/41Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • G01S13/867Combination of radar systems with cameras
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明公开了一种航迹数据处理方法、装置、车辆和介质。根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定所述当前障碍物是否与历史障碍物关联;若所述当前障碍物与历史障碍物关联,则根据所述当前障碍物的当前航迹数据和历史障碍物的前一航迹数据,更新当前障碍物的当前航迹数据。解决了自动驾驶车辆无法在低成本的条件下仅通过一个雷达准确检测车辆周围感知区间内障碍物航迹数据的问题,实现了降低硬件成本的同时,将一个雷达检测到的前一障碍物航迹数据和当前障碍物航迹数据进行关联匹配,获得稳定且准确的障碍物航迹数据的效果。

Description

一种航迹数据处理方法、装置、车辆和介质
技术领域
本发明实施例涉及自动驾驶车辆领域,尤其涉及一种航迹数据处理方法、装置、车辆和介质。
背景技术
随着智能驾驶技术的发展,自动驾驶车辆的航迹跟踪与处理是自动驾驶需要重点解决的问题。
目前,现有方案在仅依靠雷达对车辆周围障碍物航迹进行感知时,采用的航迹处理方法多是靠雷达点迹本身聚类算法的处理,对于雷达处理好的航迹数据直接与系统航迹数据进行匹配关联。由于雷达对于大车和部分小车会出现航迹分裂和ID(Identitydocument,编码)跳变,从而导致航迹跟踪出现错误。给自动驾驶车辆的行驶带来很大的危险性。
发明内容
本发明实施例提供一种航迹数据处理方法、装置、车辆和介质,以获得精准的障碍物航迹数据,提升自动驾驶车辆感知到的障碍物航迹的稳定性和准确性。
第一方面,本发明实施例提供了一种航迹数据处理方法,该方法包括:
根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定所述当前障碍物是否与所述历史障碍物关联;
若所述当前障碍物与所述历史障碍物关联,则根据所述当前障碍物的当前航迹数据和所述历史障碍物的前一航迹数据,更新所述当前障碍物的当前航迹数据。
第二方面,本发明实施例还提供了一种航迹数据处理装置,该航迹数据处理装置包括:
障碍物检测模块,用于根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定所述当前障碍物是否与所述历史障碍物关联;
计算模块,若所述当前障碍物与所述历史障碍物关联,则根据所述当前障碍物的当前航迹数据和所述历史障碍物的前一航迹数据,更新所述当前障碍物的当前航迹数据。
第三方面,本发明实施例还提供了一种自动驾驶车辆,该自动驾驶车辆包括:
一个或多个处理器;
存储装置,用于存储一个或多个程序;
航迹数据检测模块,用于采集障碍物航迹信息;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现本发明任意实施例所述的航迹数据处理方法。
第四方面,本发明实施例提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本发明任意实施例所述的航迹数据处理方法。
本发明实施例通过提供一种航迹数据处理方法、装置、车辆和介质。通过自动驾驶车辆上搭载的雷达设备,检测并获得前一时刻处于车辆周围感知区间内的障碍物(即历史障碍物)的前一航迹数据,以及当前时刻处于车辆周围感知区间内的障碍物(即当前障碍物)的当前航迹数据。采用关联匹配算法,将雷达检测到的当前航迹数据和前一航迹数据进行关联匹配,通过匹配结果判断当前时刻雷达检测到的障碍物是否与前一时刻雷达检测到的障碍物存在关联,若匹配结果证明两者存在关联性,则根据前一航迹数据更新当前航迹数据,得到准确的障碍物航迹数据。解决了自动驾驶车辆无法在低成本的条件下仅通过一个雷达准确检测车辆周围感知区间内障碍物航迹数据,以及仅通过雷达检测障碍物航迹数据容易出现航迹数据分裂,导致检测不准确的问题,实现了降低硬件成本的同时,将一个雷达检测到的前一障碍物航迹数据和当前障碍物航迹数据进行关联匹配,确定历史障碍物和当前障碍物是否为相同障碍物,从而获得稳定且准确的障碍物航迹数据的效果。
附图说明
图1为本发明实施例一提供的一种航迹数据处理方法流程图;
图2为本发明实施例二提供的一种航迹数据处理方法流程图;
图3为本发明实施例二提供的一种车辆周围感知区间划分结构图;
图4为本发明实施例三提供的一种航迹数据处理方法流程图;
图5为本发明实施例四提供的一种航迹数据处理装置的结构示意图;
图6为本发明实施例五提供的一种车辆的结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
在介绍本发明实施例之前,需要说明的是,毫米波雷达检测车辆周围感知区间内的障碍物航迹数据,是通过雷达扫描感知区间内的特征点,通过毫米波雷达自带的点聚类处理算法将扫描到的特征点聚类处理为航迹,并以车辆为原点建立空间坐标系,得到障碍物在空间坐标系中的位置信息,即障碍物ID。毫米波雷达对障碍物航迹的处理方式,可能会使毫米波雷达检测到的一个障碍物的特征点,经过聚类处理后得到多个障碍物ID。其中,雷达的特征点识别功能一般由雷达厂商提供。例如,毫米波雷达在前一时刻扫描到1000个特征点,通过点聚类处理算法得到前一时刻的障碍物(即历史障碍物)ID为3;当前时刻,毫米波雷达扫描到相同的障碍物,扫描到的特征点为1010个,其中,400个特征点通过点聚类处理算法,得到当前障碍物ID为4;另外610个特征点通过点聚类处理算法,得到另一个当前障碍物ID为8。即当前障碍物ID由前一时刻的ID3分裂为当前时刻的ID4和ID8。针对该问题,本发明实施例提供了一种航迹数据处理方法,将历史障碍物的前一航迹数据和当前障碍物的当前航迹数据进行关联匹配,确定处于分裂状态下的障碍物ID,并校正。具体实现方式见下述实施例。
实施例一
图1为本发明实施例一提供的一种航迹数据处理方法流程图,本实施例可适用于如何对障碍物航迹进行感知的情况,尤其适用于高速路段或快速路段的车辆行驶场景下,对障碍物航迹进行感知的情况。该方法可以由本发明实施例提供的航迹数据处理装置来执行,该装置可以采用软件和/或硬件的方式来实现。该装置可配置于终端设备/服务器/车载控制器中,该方法具体包括:
S110、根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定当前障碍物是否与历史障碍物关联。
其中,历史障碍物的前一航迹数据是前一时刻车辆周围感知区间内的障碍物的航迹数据,历史障碍物是前一时刻车辆周围感知区间内的障碍物。当前障碍物的当前航迹数据是当前时刻车辆周围感知区间内的障碍物的航迹数据,当前障碍物是当前时刻车辆周围感知区间内的障碍物。车辆周围感知区间内的障碍物的航迹数据可以通过车辆雷达检测得到。
历史障碍物的前一航迹数据和当前障碍物的当前航迹数据可以是由车辆雷达检测得到的,车辆雷达可以是搭载在自动驾驶车辆上的雷达设备,优选的,该雷达设备可以是毫米波雷达。毫米波雷达通过辐射的毫米波利用对探测物的反射波进行定位与回波显示,其工作的过程主要是:雷达通过射频系统辐射电磁波对障碍物进行电磁波的检测与扫描,利用反射回来的电磁波,进行放大与信号解析计算,可以计算出障碍物相对雷达的远近距离以及结合不同的方位角计算出障碍物距离雷达的左右间距。利用多普勒效应计算出障碍物的移动速度,航向角等。障碍物是车辆在行驶过程中,在车辆周围的感知区间内出现的障碍物,例如可以是处于移动过程的车辆;车辆周围的感知区间为毫米波雷达所能检测到的区域范围。航迹数据包括障碍物的移动速度、航向角、距离自动驾驶车辆的横向距离和距离自动驾驶车辆的纵向距离。
可选的,本步骤可以根据历史障碍物的前一航迹数据和当前障碍物的当前航迹数据,根据关联匹配算法,计算出当前障碍物是否可以与历史障碍物关联。
具体的,可以通过如下子步骤实现:
S1101,确定历史障碍物的位置关联阈值。
其中,位置关联阈值是指车辆与障碍物之间的距离,例如车辆与障碍物之间的长度距离、宽度距离和高度距离。位置关联阈值可以用坐标的形式表示。
具体的,由于障碍物大多数并不是一个点状物,而是有自身的尺寸参数。而雷达检测障碍物的位置时,是将障碍物识别为一个点。所以在设置位置关联阈值之前,预先设置一个障碍物的尺寸阈值,优选的,以小轿车的长、宽和高为标准,设置一个尺寸阈值为(4m,1.6m,2m)。再获得毫米波雷达检测到的前一航迹数据,得出关联阈值(X1,X2,X3,X4,X5),其中,X1为毫米波雷达检测到的障碍物移动速度,X2为障碍物移动的航向角,X3为障碍物的中心点距离自动驾驶车辆的横向距离,X4为障碍物中心点距离自动驾驶车辆的纵向距离,X5为障碍物的高度阈值。根据设置好的尺寸阈值和毫米波雷达检测到的障碍物前一航迹数据,设定一个毫米波雷达航迹的关联阈值。例如,检测到的历史障碍物的前一航迹数据为:障碍物的移动速度为80km/h,航向角为15度,距离自动驾驶车辆的横向距离为6m,距离自动驾驶车辆的纵向距离为20m,默认障碍物的高度为2m;障碍物的前一航迹数据为(80,15,6,20,2)。根据障碍物前一航迹数据得到障碍物ID为ID3。根据障碍物的尺寸阈值设置一个障碍物关联阈值,一个可行的关联阈值为:(80,15,6.8,22,2)。
S1102,根据车辆上配置的雷达可检测到的历史障碍物的前一航迹数据、当前障碍物的当前航迹数据,以及位置关联阈值,确定当前障碍物是否与历史障碍物关联。
具体的,毫米波雷达检测到当前时刻的障碍物有两个,障碍物的当前航迹数据为:障碍物的移动速度均为83km/h,航向角分别为10度和12度,距离自动驾驶车辆的横向距离分别为4m和6m,距离自动驾驶车辆的纵向距离分别为30m和26m,默认障碍物的高度为2m。据此,得到上述障碍物的当前航迹数据有两组,分别为(83,10,4,30,2)和(83,12,6,26,2)。根据障碍物当前航迹数据得到障碍物ID分别为ID4和ID8。
根据位置关联阈值,对障碍物当前航迹数据与前一航迹数据进行关联匹配,关联匹配可以通过算法实现,例如可以是匈牙利算法。算法可以搭载在车载计算机上,车载计算机可以通过传感器获得雷达检测到的障碍物航迹数据。将当前航迹数据和前一航迹数据作为算法输入,通过匈牙利算法对航迹数据进行匹配计算,将最大匹配结果与位置关联阈值作比较,判断当前航迹数据是否与前一航迹数据存在匹配关系,从而判断当前障碍物航迹数据是否与前一障碍物航迹数据相关联,即判断当前障碍物是否与历史障碍物相关联。
具体的,若通过匈牙利算法对障碍物当前航迹数据与前一航迹数据进行关联匹配,得到最大匹配结果在关联阈值范围内,则判断输出的匹配结果为当前航迹数据与前一航迹数据相关联,可以将历史障碍物和当前障碍物关联为相同障碍物。
S120、若当前障碍物与历史障碍物关联,则根据当前障碍物的当前航迹数据和历史障碍物的前一航迹数据,更新当前障碍物的当前航迹数据。
可选的,若当前障碍物与历史障碍物关联,对当前航迹数据与当前航迹数据关联的历史障碍物的前一航迹数据进行融合处理,并将融合处理结果作为更新后的当前障碍物的当前航迹数据。
具体的,当前障碍物的当前航迹数据可以是两个,例如ID4和ID8。与前障碍物的当前航迹数据关联的历史障碍物的航迹数据,为经过关联匹配确定的可以与当前障碍物关联为相同障碍物的历史障碍物的航迹数据。融合处理的过程为,根据前一障碍物航迹数据,如ID3,对当前两个障碍物进行更新,即将障碍物当前航迹数据ID4和ID8进行融合处理,将ID4和ID8融合为前一障碍物相同的ID,即ID3,并将更新后的数据通过车载显示装置进行显示。
若经过关联匹配算法得到当前障碍物与历史障碍物没有关联,则保留当前障碍物航迹数据,不做处理。
本实施例提供的技术方案,通过提供一种航迹数据处理方法、装置、车辆和介质。通过自动驾驶车辆上搭载的雷达设备,检测并获得前一时刻处于车辆周围感知区间内的障碍物(即历史障碍物)的前一航迹数据,以及当前时刻处于车辆周围感知区间内的障碍物(即当前障碍物)的当前航迹数据。采用关联匹配算法,将雷达检测到的当前航迹数据和前一航迹数据进行关联匹配,通过匹配结果判断当前时刻雷达检测到的障碍物是否与前一时刻雷达检测到的障碍物存在关联,若匹配结果证明两者存在关联性,则根据前一航迹数据更新当前航迹数据,得到准确的障碍物航迹数据。解决了自动驾驶车辆无法在低成本的条件下仅通过一个雷达准确检测车辆周围感知区间内障碍物航迹数据,并且仅通过雷达检测障碍物航迹数据容易出现航迹数据分裂,导致检测不准确的问题,实现了降低硬件成本的同时,将一个雷达检测到的前一障碍物航迹数据和当前障碍物航迹数据进行关联匹配,确定历史障碍物和当前障碍物是否为相同障碍物,从而获得稳定且准确的障碍物航迹数据的效果。
可选的,在更新当前障碍物的当前航迹数据后,还可以根据更新后的当前障碍物的当前航迹数据,调整车辆的行驶航迹。
其中,当前障碍物的当前航迹数据更新后,得到准确的处于车辆周围感知区间内的障碍物的航迹数据,根据前一障碍物ID校正并更新当前障碍物ID。车辆根据更新后的当前障碍物ID,调整车辆当前时刻的行驶航迹。具体的,车辆根据车辆感知区间内的障碍物航迹数据,调整车辆当前的速度和和航向角等车辆行驶参数。雷达继续对处于车辆周围感知区间内的障碍物航迹数据进行检测,车辆根据雷达对障碍物航迹数据的检测结果,实时更新并调整车辆的行驶航迹。
实施例二
图2为本发明实施例二提供的一种航迹数据处理方法流程图,图3为本发明实施例二提供的一种车辆周围感知区间划分结构图。本实施例在上述实施例的基础上进行了优化,给出了一种基于车辆雷达和车辆摄像头采集的障碍物数据来实现航迹数据处理方法的优选实施例。具体的,如图2所示,本实施例提供的航迹数据处理方法可以包括:
S210、根据车辆摄像头采集的历史障碍物的尺寸参数,确定历史障碍物的位置关联阈值。
在本实施例中,由于车载摄像头一般只能采集到部分区域的障碍物信息,而无法对车辆周围感知区间进行无死角的障碍物检测。因此,车辆在对其感知区间内的障碍物航迹数据进行采集时,往往借助摄像头和雷达共同执行对障碍物航迹数据的采集。其中,摄像头可以搭载在车辆上,如图3所示,将车辆摄像头可识别的感知区间作为区域一;将车辆车身左右周边到摄像头盲区的感知区间作为区域二;将自动驾驶车辆车身后部的的感知区间作为区域三。
具体的,车辆摄像头可以用于采集区域一内的障碍物航迹数据和障碍物的尺寸参数,尺寸参数包括障碍物的长、宽和高,可以表示为(X,Y,Z),其中,X为障碍物的长度,Y为障碍物的宽度,Z为障碍物的高度。根据摄像头识别到的前一时刻障碍物的尺寸数据,设定障碍物的尺寸数据为尺寸阈值,可以将自动驾驶车辆到障碍物中心点的距离设置为位置关联阈值。例如,车辆摄像头采集到的区域一内的障碍物尺寸参数为(6m,2m,4m)。再获得车辆摄像头检测到的历史障碍物的前一航迹数据,得出关联阈值(X1,X2,X3,X4,X5),其中,X1为毫米波雷达检测到的障碍物移动速度,X2为障碍物移动的航向角,X3为障碍物的中心点距离自动驾驶车辆的横向距离,X4为障碍物中心点距离自动驾驶车辆的纵向距离,X5为障碍物的高度阈值。根据设置好的尺寸阈值和毫米波雷达检测到的障碍物前一航迹数据,设定一个毫米波雷达航迹的关联阈值。例如,检测到的历史障碍物的前一航迹数据为:障碍物的移动速度为为80km/h,航向角为15度,距离自动驾驶车辆的横向距离为6m,距离自动驾驶车辆的纵向距离为20m,默认障碍物的高度为4m;障碍物的前一航迹数据为(80,15,6,20,4)。根据障碍物前一航迹数据得到障碍物ID为ID3。根据障碍物的尺寸阈值设置一个障碍物关联阈值,一个可行的位置关联阈值为:(80,15,7,23,4)。
S220、根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定当前障碍物是否与历史障碍物关联。
其中,历史障碍物的前一航迹数据是通过上述融合操作计算得出的。进一步的,根据历史障碍物的前一航迹数据和车辆上配置的雷达可检测到的当前障碍物的当前航迹数据,以及位置关联阈值,确定当前障碍物是否与历史障碍物关联。
具体的,雷达检测到当前时刻的障碍物有两个,障碍物的当前航迹数据为:障碍物的移动速度均为83km/h,航向角分别为10度和12度,距离自动驾驶车辆的横向距离分别为4m和6m,距离自动驾驶车辆的纵向距离分别为30m和26m,根据车辆摄像头采集到的障碍物尺寸阈值数默认障碍物的高度为4m。据此,得到上述障碍物的当前航迹数据有两组,分别为(83,10,4,30,4)即ID4,和(83,12,6,26,4)即ID8。
根据位置关联阈值,对障碍物的当前航迹数据与历史障碍物的前一航迹数据进行关联匹配,关联匹配可以通过算法实现,例如可以是匈牙利算法。算法可以搭载在车载计算机上,车载计算机可以通过传感器获得雷达检测到的障碍物航迹数据。将当前航迹数据和历史障碍物的前一航迹数据作为算法输入,通过匈牙利算法对航迹数据进行匹配计算,将最大匹配结果与位置关联阈值作比较,判断当前航迹数据是否与前一航迹数据存在匹配关系,从而判断当前障碍物航迹数据是否与历史障碍物的前一航迹数据相关联,即判断当前障碍物是否与历史障碍物相关联。
S230、若当前障碍物与历史障碍物关联,则根据当前障碍物的当前航迹数据和历史障碍物的前一航迹数据,更新当前障碍物的当前航迹数据。
此外,区域二和区域三,均为摄像头盲区区间。在通过摄像头确定位置关联阈值之后,对区域二和区域三内的障碍物航迹数据的检测与更新,可以仅通过雷达完成,具体方法和上述实施例一所用方法一致,此处不再赘述。
本实施例的技术方案,先将车辆周围感知区间划分为三部分,通过摄像头采集摄像头可识别的感知区间,即区域一内前一时刻历史障碍物的前一航迹数据和历史障碍物的尺寸参数,通过车辆摄像头采集到的的信息,计算出位置关联阈值。再通过雷达检测到前一时刻历史障碍物的前一航迹数据,将摄像头和雷达采集到的前一航迹数据进行时间同步和融合操作,将融合操作后的结果作为历史障碍物的前一航迹数据。再通过雷达检测到当前时刻障碍物的当前航迹数据,采用关联匹配算法,将当前航迹数据和历史障碍物的前一航迹数据进行关联匹配,通过匹配结果判断当前时刻检测到的障碍物是否与前一时刻检测到的障碍物存在关联,若匹配结果证明两者存在关联性,则根据前一航迹数据更新当前航迹数据,得到稳定的障碍物航迹数据,并可以根据障碍物航迹数据调整车辆的行驶航迹。解决了人为定义一个固定的障碍物尺寸参数,根据固定尺寸参数获得位置关联阈值,造成对当前障碍物和历史障碍物航迹数据的关联匹配结果上存在一定误差的问题,达到了结合摄像头和雷达,实时更新障碍物的尺寸参数和位置关联阈值,得到准确且灵活的障碍物尺寸参数和位置关联阈值,从而对当前航迹数据和历史障碍物的前一航迹数据进行更精准的关联匹配,获得更加准确的关联匹配结果的效果。
在本实施例提供的航迹数据处理方法中,一个优选的技术方案是,若车辆摄像头在前一时刻检测到了所述历史障碍物,则所述历史障碍物的前一航迹数据是对车辆雷达刻检测到的历史障碍物的前一航迹数据和车辆摄像头检测到的历史障碍物的前一航迹数据进行时间同步后,融合得到的。
具体的,若要对航迹数据进行时间同步,可以定义一个时长阈值,若雷达检测到障碍物航迹数据的时间和摄像头检测到障碍物航迹数据的时间间隔小于时长阈值,则判断雷达和摄像头检测到障碍物航迹数据的时间是同步的。
例如,将摄像头采集到区域一内障碍物航迹数据的时间定义为第一采集时间,雷达采集到区域一内障碍物的航迹数据的时间定义为第二采集时间。当摄像头和雷达采集到障碍物前一航迹数据后,可以通过传感器将第一采集时间、第二采集时间、摄像头采集到的前一航迹数据和雷达采集到的前一航迹数据发送给车载计算机设备。由车载计算机设备计算出第一采集时间和第二采集时间的间隔时长,若间隔时长在阈值范围内,则将摄像头采集到的前一航迹数据和雷达采集到的前一航迹数据进行融合操作,得到融合后的前一航迹数据。
融合操作是指通过算法,如卡尔曼滤波算法,将摄像头采集到的前一航迹数据和雷达采集到的前一航迹数据进行融合计算,得到车辆的航迹数据融合信息,即融合后的历史障碍物的前一航迹数据。示例性的,时长阈值可以定义为0.05s,若第一采集时间和第二采集时间之间的间隔时长小于0.05s,则触发融合操作,得到历史障碍物的前一航迹数据。
实施例三
图4为本发明实施例三提供的一种航迹数据处理方法流程图。可选的,如图4所示,以自动驾驶车辆为例,车载雷达可以是毫米波雷达。
自动驾驶车辆通过车载计算机通过GPS判断车辆是否在ODD(Operational DesignDomain运行设计域)中,本实施例中车辆ODD是指车辆行驶在高速路段中。在实际应用中,也可以是其他的ODD环境。若车辆行驶在ODD中,则对自动驾驶车辆周围感知区间进行划分。车载计算机接收摄像头及毫米波雷达检测到的障碍物航迹数据,采用卡尔曼滤波算法对摄像头采集到的障碍物航迹数据和雷达采集到的障碍物航迹数据进行时间同步。针对车辆不同感知区间,对检测到的障碍物航迹进行分别处理。
毫米波雷达和车载计算机均能检测到障碍物航迹数据的车辆感知区间为区域一。车载计算机接收到摄像头和毫米波雷达检测到的历史障碍物的前一航迹数据,识别出障碍物的尺寸参数和障碍物与车辆的位置关系,根据以上数据设置障碍物的尺寸阈值和位置关联阈值,并对摄像头检测到的前一航迹数据和毫米波雷达检测到的前一航迹数据进行融合操作,得到融合后的前一航迹数据。车载计算机接收到毫米波雷达检测到的当前障碍物的当前航迹数据,根据位置关联阈值,采用匈牙利算法对障碍物的当前航迹数据与历史障碍物的前一航迹数据进行关联匹配,若当前航迹数据与前一航迹数据存在匹配关系,则车载计算机将毫米波雷达检测到的当前航迹数据进行整合,得到稳定的障碍物航迹数据,并对障碍物航迹进行下一轮的跟踪计算。
仅有毫米波雷达可以检测到障碍物航迹数据的车辆两侧的感知区间为区域二,用过毫米波雷达检测到前一航迹数据,并根据车辆的常规尺寸人为设定障碍物的尺寸阈值,并根据尺寸阈值计算出位置关联阈值。再采用毫米波雷达检测到当前航迹数据,采用匈牙利算法对当前航迹数据与前一航迹数据进行关联匹配,若当前航迹数据与前一航迹数据存在匹配关系,则车载计算机将毫米波雷达检测到的当前航迹数据进行整合,得到稳定的障碍物航迹数据,并对障碍物航迹进行下一轮的跟踪计算。
将车辆后方的感知区间作为区域三,毫米波雷达检测到区域三内的障碍物不做处理。
本实施例的技术方案,通过将行驶在车辆ODD环境的车辆周围的感知区域进行划分,不同的感知区域采用不同的障碍物检测设备对障碍物进行检测。对于摄像头和雷达都能检测到障碍物航迹数据的感知区域,将摄像头和雷达检测到的障碍物航迹数据进行融合,将融合结果作为检测到的障碍物航迹数据,并可以根据摄像头采集到的障碍物尺寸信息设定位置关联阈值;对于仅有雷达可以检测到障碍物航迹数据的感知区域,则仅通过雷达检测障碍物的航迹数据。解决了仅通过雷达或摄像头检测车辆周围的感知区域障碍物航迹导致的检测结果不准确的问题。将车辆周围的感知区域进行划分,充分发挥摄像头和雷达在检测障碍物航迹数据时的性能优势,从而得到更加准确的障碍物航迹数据。
实施例四
图5为本发明实施例四提供的一种航迹数据处理装置的结构示意图,本实施例可适用于对车辆周围感知区间内的障碍物航迹数据进行检测和更新的情况,如图5所示,该航迹数据处理装置包括:障碍物检测模块410和计算模块420。
其中,障碍物检测模块410用于根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定当前障碍物是否与历史障碍物关联;
计算模块420,用于根据当前障碍物的当前航迹数据和历史障碍物的前一航迹数据,更新当前障碍物的当前航迹数据。
本实施例提供的技术方案,通过自动驾驶车辆上搭载的雷达设备,检测并获得前一时刻处于车辆周围感知区间内的障碍物的前一航迹数据,以及当前时刻处于车辆周围感知区间内的障碍物的当前航迹数据。根据车辆尺寸和障碍物航迹数据得到障碍物航迹数据,通过前一时刻障碍物的前一航迹数据确定障碍物的位置关联阈值。采用关联匹配算法,将雷达检测到的当前航迹数据和前一航迹数据进行关联匹配,通过匹配结果判断当前时刻雷达检测到的障碍物是否与前一时刻雷达检测到的障碍物存在关联,若匹配结果证明两者存在关联性,则根据前一航迹数据更新当前航迹数据,得到稳定的障碍物航迹数据,并可以根据障碍物航迹数据调整车辆的行驶航迹。解决了自动驾驶车辆无法在低成本的条件下仅通过一个雷达准确检测车辆周围感知区间内障碍物航迹数据的问题,实现了降低硬件成本的同时,将一个雷达检测到的前一障碍物航迹数据和当前障碍物航迹数据进行关联匹配,获得稳定且准确的障碍物航迹数据的效果。
其中,障碍物检测模块410,可以具体用于:
确定历史障碍物的位置关联阈值;
根据历史障碍物的前一航迹数据、车辆雷达检测到的当前障碍物的当前航迹数据,以及位置关联阈值,确定当前障碍物是否与历史障碍物关联。
其中,确定历史障碍物的位置关联阈值,包括:
根据车辆摄像头采集的历史障碍物的尺寸参数,确定历史障碍物的位置关联阈值。
进一步的,计算模块420,可以具体用于:
对当前障碍物的当前航迹数据与当前航迹数据关联的历史障碍物的前一航迹数据进行融合处理,并将处理结果作为更新后的当前障碍物的当前航迹数据。
若车辆摄像头在前一时刻检测到了历史障碍物,则历史障碍物的前一航迹数据是对车辆雷达刻检测到的历史障碍物的前一航迹数据和车辆摄像头检测到的历史障碍物的前一航迹数据进行时间同步后,融合得到的。
其中,更新当前障碍物的当前航迹数据后,还包括:
根据更新后的当前障碍物的当前航迹数据,调整车辆的行驶航迹。
示例性的,上述装置还包括:摄像头、传感器、车载计算机和雷达。
本实施例提供的车辆定位装置可适用于上述任意实施例提供的航迹数据处理方法,具备相应的功能和有益效果。
实施例五
图6为本发明实施例五提供的一种车辆的结构示意图。如图6所示,该车辆包括处理器510、存储器520和检测器530;车辆中处理器510的数量可以是一个或多个,图6中以一个处理器510为例;车辆中的处理器510、存储器520和检测器530可以通过总线或其他方式连接,图6中以通过总线连接为例。
存储器520作为一种计算机可读存储介质,可用于存储软件程序、计算机可执行程序以及模块,如本发明实施例中的航迹数据处理方法对应的程序指令/模块(例如,航迹数据处理装置中的障碍物检测模块410和计算模块420)。处理器510通过运行存储在存储器520中的软件程序、指令以及模块,从而执行车辆的各种功能应用以及数据处理,即实现上述的自动驾驶车辆的定位方法。
存储器520可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序;存储数据区可存储根据终端的使用所创建的数据等。此外,存储器520可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实例中,存储器520可进一步包括相对于处理器510远程设置的存储器,这些远程存储器可以通过网络连接至车辆。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
检测器530可用于获取车辆感知区间内的障碍物航迹数据,对障碍物的航迹进行跟踪。
本实施例提供的车辆可适用于上述任意实施例提供的航迹数据处理方法,具备相应的功能和有益效果。
实施例六
本发明实施例六还提供一种包含计算机可执行指令的存储介质,所述计算机可执行指令在由计算机处理器执行时用于执行一种航迹数据处理方法,该方法包括:
根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定当前障碍物是否与所述历史障碍物关联;
若当前障碍物与所述历史障碍物关联,则根据当前障碍物的当前航迹数据和历史障碍物的前一航迹数据,更新当前障碍物的当前航迹数据。
当然,本发明实施例所提供的一种包含计算机可执行指令的存储介质,其计算机可执行指令不限于如上所述的方法操作,还可以执行本发明任意实施例所提供的航迹数据处理方法中的相关操作。
通过以上关于实施方式的描述,所属领域的技术人员可以清楚地了解到,本发明可借助软件及必需的通用硬件来实现,当然也可以通过硬件实现,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如计算机的软盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(RandomAccess Memory,RAM)、闪存(FLASH)、硬盘或光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述的方法。
值得注意的是,上述航迹数据处理方法的实施例中,所包括的各个单元和模块只是按照功能逻辑进行划分的,但并不局限于上述的划分,只要能够实现相应的功能即可;另外,各功能单元的具体名称也只是为了便于相互区分,并不用于限制本发明的保护范围。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。

Claims (10)

1.一种航迹数据处理方法,其特征在于,包括:
根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定所述当前障碍物是否与所述历史障碍物关联;
若所述当前障碍物与所述历史障碍物关联,则根据所述当前障碍物的当前航迹数据和所述历史障碍物的前一航迹数据,更新所述当前障碍物的当前航迹数据。
2.根据权利要求1所述的方法,其特征在于,根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定所述当前障碍物是否与所述历史障碍物关联,包括:
确定所述历史障碍物的位置关联阈值;
根据所述历史障碍物的前一航迹数据、车辆雷达检测到的所述当前障碍物的当前航迹数据,以及所述位置关联阈值,确定所述当前障碍物是否与所述历史障碍物关联。
3.根据权利要求2所述的方法,其特征在于,确定所述历史障碍物的位置关联阈值,包括:
根据车辆摄像头采集的所述历史障碍物的尺寸参数,确定所述历史障碍物的位置关联阈值。
4.根据权利要求1所述的方法,其特征在于,根据所述当前障碍物的当前航迹数据和所述历史障碍物的前一航迹数据,更新所述当前障碍物的当前航迹数据,包括:
对所述当前障碍物的当前航迹数据与所述当前航迹数据关联的所述历史障碍物的前一航迹数据进行融合处理,并将处理结果作为更新后的所述当前障碍物的当前航迹数据。
5.根据权利要求1所述的方法,其特征在于,包括:
若车辆摄像头在前一时刻检测到了所述历史障碍物,则所述历史障碍物的前一航迹数据是对所述车辆雷达刻检测到的所述历史障碍物的前一航迹数据和所述车辆摄像头检测到的所述历史障碍物的前一航迹数据进行时间同步后,融合得到的。
6.根据权利要求1所述的方法,其特征在于,更新所述当前障碍物的当前航迹数据,还包括:
根据更新后的所述当前障碍物的当前航迹数据,调整车辆的行驶航迹。
7.一种航迹数据处理装置,其特征在于,包括:
障碍物检测模块,用于根据历史障碍物的前一航迹数据,和车辆雷达检测到的当前障碍物的当前航迹数据,确定所述当前障碍物是否与所述历史障碍物关联;
计算模块,若所述当前障碍物与所述历史障碍物关联,则根据所述当前障碍物的当前航迹数据和所述历史障碍物的前一航迹数据,更新所述当前障碍物的当前航迹数据。
8.根据权利要求7所述的装置,其特征在于,所述障碍物检测模块,具体用于:
确定所述历史障碍物的位置关联阈值;
根据所述历史障碍物的前一航迹数据、车辆雷达检测到的所述当前障碍物的当前航迹数据,以及所述位置关联阈值,确定所述当前障碍物是否与所述历史障碍物关联。
9.一种自动驾驶车辆,其特征在于,所述车辆包括:
一个或多个处理器;
存储装置,用于存储一个或多个程序;
航迹数据检测模块,用于采集障碍物航迹信息;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1-6中任一所述的航迹数据处理方法。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1-6中任一所述的航迹数据处理方法。
CN202210101307.5A 2022-01-27 2022-01-27 一种航迹数据处理方法、装置、车辆和介质 Pending CN114488065A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210101307.5A CN114488065A (zh) 2022-01-27 2022-01-27 一种航迹数据处理方法、装置、车辆和介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210101307.5A CN114488065A (zh) 2022-01-27 2022-01-27 一种航迹数据处理方法、装置、车辆和介质

Publications (1)

Publication Number Publication Date
CN114488065A true CN114488065A (zh) 2022-05-13

Family

ID=81477348

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210101307.5A Pending CN114488065A (zh) 2022-01-27 2022-01-27 一种航迹数据处理方法、装置、车辆和介质

Country Status (1)

Country Link
CN (1) CN114488065A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115476762A (zh) * 2022-09-09 2022-12-16 中国第一汽车股份有限公司 一种车辆开门预警方法、装置、设备和存储介质

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106569214A (zh) * 2016-10-31 2017-04-19 惠州市德赛西威汽车电子股份有限公司 结合导航信息的自适应巡航车载雷达数据处理方法及系统
CN107341819A (zh) * 2017-05-09 2017-11-10 深圳市速腾聚创科技有限公司 目标跟踪方法及存储介质
CN108470353A (zh) * 2018-03-01 2018-08-31 腾讯科技(深圳)有限公司 一种目标跟踪方法、装置和存储介质
CN108985171A (zh) * 2018-06-15 2018-12-11 上海仙途智能科技有限公司 运动状态估计方法和运动状态估计装置
CN109801508A (zh) * 2019-02-26 2019-05-24 百度在线网络技术(北京)有限公司 路口处障碍物的运动轨迹预测方法及装置
CN110517483A (zh) * 2019-08-06 2019-11-29 杭州博信智联科技有限公司 一种路况信息处理方法及数字轨路侧单元
CN111316128A (zh) * 2018-12-28 2020-06-19 深圳市大疆创新科技有限公司 连续障碍物检测方法、设备、系统及存储介质
CN112418092A (zh) * 2020-11-23 2021-02-26 中国第一汽车股份有限公司 一种障碍物感知的融合方法、装置、设备及储存介质
CN112507949A (zh) * 2020-12-18 2021-03-16 北京百度网讯科技有限公司 目标跟踪方法、装置、路侧设备以及云控平台
CN113064415A (zh) * 2019-12-31 2021-07-02 华为技术有限公司 轨迹规划的方法、装置、控制器和智能车
CN113281760A (zh) * 2021-05-21 2021-08-20 阿波罗智能技术(北京)有限公司 障碍物检测方法、装置、电子设备、车辆和存储介质
CN113514806A (zh) * 2021-04-02 2021-10-19 苏州挚途科技有限公司 自动驾驶过程中障碍物确定方法、装置及电子设备

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106569214A (zh) * 2016-10-31 2017-04-19 惠州市德赛西威汽车电子股份有限公司 结合导航信息的自适应巡航车载雷达数据处理方法及系统
CN107341819A (zh) * 2017-05-09 2017-11-10 深圳市速腾聚创科技有限公司 目标跟踪方法及存储介质
CN108470353A (zh) * 2018-03-01 2018-08-31 腾讯科技(深圳)有限公司 一种目标跟踪方法、装置和存储介质
CN108985171A (zh) * 2018-06-15 2018-12-11 上海仙途智能科技有限公司 运动状态估计方法和运动状态估计装置
CN111316128A (zh) * 2018-12-28 2020-06-19 深圳市大疆创新科技有限公司 连续障碍物检测方法、设备、系统及存储介质
CN109801508A (zh) * 2019-02-26 2019-05-24 百度在线网络技术(北京)有限公司 路口处障碍物的运动轨迹预测方法及装置
CN110517483A (zh) * 2019-08-06 2019-11-29 杭州博信智联科技有限公司 一种路况信息处理方法及数字轨路侧单元
CN113064415A (zh) * 2019-12-31 2021-07-02 华为技术有限公司 轨迹规划的方法、装置、控制器和智能车
CN112418092A (zh) * 2020-11-23 2021-02-26 中国第一汽车股份有限公司 一种障碍物感知的融合方法、装置、设备及储存介质
CN112507949A (zh) * 2020-12-18 2021-03-16 北京百度网讯科技有限公司 目标跟踪方法、装置、路侧设备以及云控平台
CN113514806A (zh) * 2021-04-02 2021-10-19 苏州挚途科技有限公司 自动驾驶过程中障碍物确定方法、装置及电子设备
CN113281760A (zh) * 2021-05-21 2021-08-20 阿波罗智能技术(北京)有限公司 障碍物检测方法、装置、电子设备、车辆和存储介质

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115476762A (zh) * 2022-09-09 2022-12-16 中国第一汽车股份有限公司 一种车辆开门预警方法、装置、设备和存储介质
CN115476762B (zh) * 2022-09-09 2024-10-18 中国第一汽车股份有限公司 一种车辆开门预警方法、装置、设备和存储介质

Similar Documents

Publication Publication Date Title
US20210261154A1 (en) Continuous obstacle detection method, device, and system, and storage medium
US20220410939A1 (en) Collision detection method, electronic device, and medium
CN113093178A (zh) 一种障碍物目标检测方法、装置、域控制器及车辆
US8762042B2 (en) Periphery vehicle determination apparatus
JP5835243B2 (ja) 物標認識装置
US20200110173A1 (en) Obstacle detection method and device
JP2005084034A (ja) 物体検出装置
JP2016148547A (ja) 検知装置
CN110866544B (zh) 传感器数据的融合方法、装置及存储介质
CN110940979A (zh) 障碍物检测方法、装置、设备以及存储介质
CN111986232B (zh) 目标物体的检测方法、装置、机器人及存储介质
CN113536850A (zh) 基于77g毫米波雷达的目标物体大小测试方法和装置
CN111361570B (zh) 一种多目标跟踪反向验证方法及存储介质
CN113611112B (zh) 一种目标关联方法、装置、设备及存储介质
US10970870B2 (en) Object detection apparatus
CN114488065A (zh) 一种航迹数据处理方法、装置、车辆和介质
CN110941003A (zh) 车辆识别方法,装置,存储介质及电子设备
CN110888135B (zh) 目标识别的方法、装置以及存储介质和车辆
JP7107660B2 (ja) 車載システム、物標認識方法及びコンピュータプログラム
Polychronopoulos et al. Integrated object and road border tracking using 77 GHz automotive radars
JP6555132B2 (ja) 移動物体検出装置
CN115014366B (zh) 一种目标融合方法、装置、车辆及存储介质
CN113879312B (zh) 基于多传感器融合的前向目标选择方法、装置和存储介质
US11983937B2 (en) Intersecting road estimation device
CN108416305B (zh) 连续型道路分割物的位姿估计方法、装置及终端

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination