CN109765563B - 一种超声波雷达阵列、障碍物检测方法及系统 - Google Patents

一种超声波雷达阵列、障碍物检测方法及系统 Download PDF

Info

Publication number
CN109765563B
CN109765563B CN201910036318.8A CN201910036318A CN109765563B CN 109765563 B CN109765563 B CN 109765563B CN 201910036318 A CN201910036318 A CN 201910036318A CN 109765563 B CN109765563 B CN 109765563B
Authority
CN
China
Prior art keywords
ultrasonic radar
ultrasonic
obstacle
radar
radars
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.)
Active
Application number
CN201910036318.8A
Other languages
English (en)
Other versions
CN109765563A (zh
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.)
Apollo Intelligent Technology Beijing Co Ltd
Original Assignee
Beijing Baidu Netcom Science and Technology Co Ltd
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 Beijing Baidu Netcom Science and Technology Co Ltd filed Critical Beijing Baidu Netcom Science and Technology Co Ltd
Priority to CN201910036318.8A priority Critical patent/CN109765563B/zh
Publication of CN109765563A publication Critical patent/CN109765563A/zh
Priority to PCT/CN2019/127358 priority patent/WO2020147518A1/zh
Priority to EP19910464.7A priority patent/EP3842834A4/en
Priority to US17/278,646 priority patent/US11933893B2/en
Priority to JP2020570048A priority patent/JP2021526649A/ja
Application granted granted Critical
Publication of CN109765563B publication Critical patent/CN109765563B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • 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
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/87Combinations of sonar systems
    • 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/52Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S15/00
    • G01S7/52004Means for monitoring or calibrating
    • 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/52Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S15/00
    • G01S7/521Constructional features
    • 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/52Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S15/00
    • G01S7/523Details of pulse systems
    • G01S7/526Receivers
    • G01S7/53Means for transforming coordinates or for evaluating data, e.g. using computers
    • 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
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/937Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles sensor installation details
    • G01S2015/938Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles sensor installation details in the bumper area

Abstract

本申请提供一种超声波雷达阵列及其障碍物检测方法及系统,所述方法包括获取所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息;根据预设规则对各超声波雷达采集的障碍物信息进行误检及漏检判断;根据所述判断结果对各超声波雷达采集的障碍物信息进行处理;根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置。可以有效判断超声波雷达阵列中各超声波雷达出现的误检和漏检,精确确定障碍物位置,提高了无人驾驶车辆的行驶安全性。

Description

一种超声波雷达阵列、障碍物检测方法及系统
【技术领域】
本申请涉及自动控制领域,尤其涉及一种超声波雷达阵列、障碍物检测方法及系统。
【背景技术】
无人驾驶车辆是一种智能汽车,也可以称之为轮式移动机器人,主要依靠车辆内的以计算机系统为主的智能驾驶仪来实现无人驾驶。无人驾驶汽车集自动控制、体系结构、人工智能、视觉计算等众多技术于一体,是计算机科学、模式识别和智能控制技术高度发展的产物,也是衡量一个国家科研实力和工业水平的一个重要标志,在国防和国民经济领域具有广阔的应用前景。
超声波具有较好的方向性、较强的适应性以及穿透能力强等特点,因此往往被加载在无人驾驶车辆上实现避障功能。目前应用于无人驾驶车辆的传统超声波雷达阵列,一般是安装在汽车前/后保险杠上,个数为4个。其测量障碍物并不稳定,且伴随着误检漏检;无法精确描述障碍物位置;横向检测盲区往往较大,存在安全隐患;在无人驾驶车辆等精度要求较高的领域,很难达到感知要求,这降低了无人驾驶车辆行驶的安全性。
【发明内容】
本申请的多个方面提供一种超声波雷达阵列、障碍物检测方法及系统,用以提高超声波障碍物检测的准确性和可靠性,覆盖无人驾驶车辆横向盲区,提高行驶安全性。
本申请的一方面,提供一种超声波雷达阵列,包括:均匀安装在无人驾驶车辆保险杠上的N个超声波雷达,所述N个超声波雷达从中央到外侧,向外旋转角度逐渐增大;其中,N为正整数。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,若N为偶数,则第一超声波雷达水平安装于保险杠中央左侧,第二超声波雷达水平安装于保险杠中央右侧;(N-2)/2个超声波雷达安装于第一超声波雷达左侧,从中央到外侧,以上一个超声波雷达为基准,依次逆时针旋转α;(N-2)/2个超声波雷达安装于第二超声波雷达右侧,从中央到外侧,以上一个超声波雷达为基准,依次顺时针旋转α;
若N为奇数,则第一超声波雷达水平安装于保险杠中央,(N-1)/2个超声波雷达安装于第一超声波雷达左侧,从中央到外侧,以上一个超声波雷达为基准,依次逆时针旋转α;(N-1)/2个超声波雷达安装于第一超声波雷达右侧,从中央到外侧,以上一个超声波雷达为基准,依次顺时针旋转α。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,根据每个超声波雷达的探测距离及探测形状的数学模型,确定超声波雷达的个数N及旋转角度α,以保证超声波雷达的覆盖范围存在三重冗余。
本发明提供了一种根据上述超声波雷达阵列的障碍物检测方法,其特征在于,包括:
获取所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息;
根据预设规则对各超声波雷达采集的障碍物信息进行误检及漏检判断;
根据所述判断结果对各超声波雷达采集的障碍物信息进行处理;
根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,所述预设规则为根据待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标判断所述待判断超声波雷达是否存在误检及漏检。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,所述相邻超声波雷达为与所述待判断超声波雷达两侧的超声波雷达和间隔一个的超声波雷达。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,进行误检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,若所述待判断超声波雷达的覆盖范围存在单个超声波雷达覆盖范围或两个超声波雷达覆盖范围重叠,则不存在误检;若所述待判断超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则存在误检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,不存在误检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,不存在误检。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,进行漏检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,所述待判断超声波雷达不存在漏检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在两个超声波雷达覆盖范围重叠,则存在漏检;若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在三个超声波雷达覆盖范围,则存在漏检;若不存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的三个及以上相邻超声波雷达返回障碍物坐标的情况下,存在漏检。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,根据所述判断结果对各超声波雷达采集的障碍物信息进行处理包括:
若所述超声波雷达采集的障碍物信息存在误检,则删除所述误检的超声波雷达采集的障碍物信息。
若所述超声波雷达采集的障碍物信息存在漏检,根据其相邻超声波雷达返回的障碍物信息得到所述漏检的超声波雷达采集的障碍物信息。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置包括:
融合多个超声波雷达返回的距离数据,获取障碍物的坐标。
本发明提供了一种根据上述超声波雷达阵列的障碍物检测系统,包括:
获取模块,用于获取所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息;
判断模块,用于根据预设规则对各超声波雷达采集的障碍物信息进行误检及漏检判断;
处理模块,用于根据所述判断结果对各超声波雷达采集的障碍物信息进行处理;
确定模块,用于根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,所述预设规则为根据待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标判断所述待判断超声波雷达是否存在误检及漏检。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,所述相邻超声波雷达为与所述待判断超声波雷达两侧的超声波雷达和间隔一个的超声波雷达。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,进行误检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,若所述待判断超声波雷达的覆盖范围存在单个超声波雷达覆盖范围或两个超声波雷达覆盖范围重叠,则不存在误检;若所述待判断超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则存在误检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,不存在误检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,不存在误检。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,进行漏检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,所述待判断超声波雷达不存在漏检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在两个超声波雷达覆盖范围重叠,则存在漏检;若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在三个超声波雷达覆盖范围,则存在漏检;若不存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的三个及以上相邻超声波雷达返回障碍物坐标的情况下,存在漏检。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,所述处理模块具体用于:
若所述超声波雷达采集的障碍物信息存在误检,则删除所述误检的超声波雷达采集的障碍物信息。
若所述超声波雷达采集的障碍物信息存在漏检,根据其相邻超声波雷达返回的障碍物信息得到所述漏检的超声波雷达采集的障碍物信息。
如上所述的方面和任一可能的实现方式,进一步提供一种实现方式,所述确定模块具体用于:
融合多个超声波雷达返回的距离数据,获取障碍物的坐标。
本发明的另一方面,提供一种计算机设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述程序时实现如以上所述的方法。
本发明的另一方面,提供一种计算机可读存储介质,其上存储有计算机程序,所述程序被处理器执行时实现如以上所述的方法。
由所述技术方案可知,本申请实施例可以有效判断超声波雷达阵列中各超声波雷达出现的误检和漏检,精确确定障碍物位置,提高了无人驾驶车辆的行驶安全性。
【附图说明】
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例一提供的超声波雷达阵列的结构示意图;
图2为本申请实施例二提供的超声波雷达阵列障碍物检测方法的流程示意图;
图3为本申请实施例三提供的超声波雷达阵列障碍物检测系统的结构示意图;
图4示出了适于用来实现本发明实施方式的示例性计算机系统/服务器012的框图。
【具体实施方式】
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的全部其他实施例,都属于本申请保护的范围。
图1为本申请实施例一提供的超声波雷达阵列的结构示意图,如图1所示,包括:
所述超声波雷达阵列包括10个超声波雷达,每个超声波雷达均由超声波发射电路以及超声波接收电路构成;
超声波雷达九、七、五、三、一、二、四、六、八、十均匀安装在无人驾驶车辆的前保险杠上,其安装角度从最左侧安装的超声波雷达九的以水平为基准,逆时针旋转4α开始,每个超声波雷达依次顺时针旋转α,直到最右侧安装的超声波雷达十,其以水平为基准,顺时针旋转4α。
具体如下:十个超声波雷达均匀安装在无人驾驶车辆的前保险杠上,超声波雷达一水平安装于前保险杆中央左侧;超声波雷达二水平安装于前保险杠中央右侧;超声波雷达三安装于超声波雷达一左侧,以水平为基准,逆时针旋转α;超声波雷达四安装于超声波雷达二右侧,以水平为基准,顺时针旋转α;超声波雷达五安装于超声波雷达三左侧,以水平为基准,逆时针旋转2α;超声波雷达六安装于超声波雷达四右侧,以水平为基准,顺时针旋转2α;超声波雷达七安装于超声波雷达五左侧,以水平为基准,逆时针旋转3α;超声波雷达八安装于超声波雷达六右侧,以水平为基准,顺时针旋转3α;超声波雷达九安装于超声波雷达五左侧,以水平为基准,逆时针旋转4α;超声波雷达十安装于超声波雷达八右侧,以水平为基准,顺时针旋转4α;
其中,α优选为5°。所述超声波雷达的水平波束角为45°,超声波雷达的覆盖范围为0-3.5m。
由于所述十个超声波雷达的覆盖范围相互叠加,具有一定的容错能力。需要确定所述超声波雷达相互叠加的覆盖范围,以便在后续的障碍物检测过程中进行检错纠错。
优选地,根据每个超声波雷达的探测距离及探测形状的数学模型,确定各超声波雷达在自身坐标系中的覆盖范围。
将各超声波雷达坐标系同一到参考坐标系中。本实施例中,所述参考坐标系为车辆坐标系。通过各超声波雷达在无人驾驶车辆上的初始空间配置与车辆坐标系的关系进行矩阵转换。所述超声波雷达的初始空间配置是事先已知的,可以根据所述多个超声波雷达在无人驾驶车辆车体上的测量数据得到。
将统一到参考坐标系后的各超声波雷达覆盖范围在预设检测区域中进行叠加。优选地,所述栅格化的预设检测区域为车体前方及侧前方15-350cm范围内。
通过上述步骤,可以获得所述超声波雷达阵列的覆盖范围,以及各超声波雷达覆盖范围的重叠情况,例如,是单个超声波雷达覆盖范围,两个超声波雷达覆盖范围重叠,三个超声波雷达覆盖范围重叠等。
确定超声波雷达覆盖范围的重叠情况是很有必要的,例如,障碍物出现在超声波雷达九的覆盖范围中,可能存在多种情况,障碍物位于超声波雷达九的覆盖范围中单个超声波雷达覆盖范围,两个超声波雷达覆盖范围重叠,三个超声波雷达覆盖范围重叠三种情况。在本实施例中,由于超声波雷达的作用是测量障碍物,对误检的容忍度高于漏检,因此,即使仅有超声波雷达九返回障碍物信息,也认为所述障碍物位于超声波雷达九的覆盖范围中单个超声波雷达覆盖范围,而非其相邻的超声波雷达七或超声波雷达五出现漏检。
其中,在无人驾驶车辆前方2m的范围内,可以做到3个超声波雷达的覆盖范围重叠,以便决策系统根据3个超声波雷达返回的障碍物信息进行投票。
通过本实施例提供的超声波雷达阵列,通过多超声波雷达覆盖范围叠加,实现了障碍物检测的容错能力。
图2为本申请实施例二提供的超声波雷达阵列障碍物检测方法的流程示意图,如图2所示,包括:
步骤S21、获取如实施例一中所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息,并将各坐标转换到车体坐标系;
所述超声波雷达的初始空间配置是事先已知的,可以根据所述多个超声波雷达在无人驾驶车辆车体上的测量数据得到。将目标在各雷达坐标系中的坐标转换到车体坐标系中。
步骤S22、根据预设规则对所述超声波雷达阵列中的各超声波雷达采集的障碍物信息进行误检及漏检判断。
所述预设规则的基本原理是,当一个超声波雷达误检时,若其相邻超声波雷达未发生误检,将不返回障碍物坐标;当一个超声波雷达漏检时,若其相邻超声波雷达未发生漏检,将返回障碍物坐标。
进行误检判断的规则如下:
若接收到超声波雷达返回的障碍物坐标,判断待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标;
若所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标,则判断所述待判断超声波雷达是否存在单个超声波雷达覆盖范围,例如位于超声波雷达阵列边缘的超声波雷达九、超声波雷达十;
若所述待判断超声波雷达的覆盖范围存在单个超声波雷达覆盖范围,则认为障碍物出现在了所述待判断超声波雷达的单个超声波雷达覆盖范围内;所述待判断超声波雷达未出现误检;
若所述超声波雷达的覆盖范围存在两个超声波雷达覆盖范围,例如超声波雷达七、超声波雷达八,其检测范围至少与一个相邻超声波雷达覆盖范围重叠,如超声波雷达七返回障碍物坐标,而相邻的超声波雷达九未返回障碍物坐标、相邻的超声波雷达五也未返回障碍物坐标;这就存在多种可能,如障碍物位于超声波雷达七覆盖范围中的两个超声波雷达覆盖范围,即与超声波雷达九重叠的覆盖范围内,则可能是超声波雷达九漏检,也可能是超声波雷达七误检。如果障碍物位于超声波雷达七覆盖范围中的三个超声波雷达覆盖范围,即与超声波雷达九、超声波雷达五重叠的覆盖范围内,则由于超声波雷达九、超声波雷达五都未返回障碍物坐标,则可能是超声波雷达七误检。为了安全起见,认为障碍物位于超声波雷达七覆盖范围中的两个超声波雷达覆盖范围,即与超声波雷达九重叠的覆盖范围内,是超声波雷达九漏检。因为,如果误检,只可能造成无人驾驶车辆停车,等待下一时刻检测结果,如果是漏检,则很可能造成碰撞。
若所述超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,例如超声波雷达五、超声波雷达三、超声波雷达一、超声波雷达二、超声波雷达四、超声波雷达六,其检测范围与两个相邻超声波雷达覆盖范围重叠,在两个相邻超声波雷达都未返回障碍物检测结果的情况下,则认为所述待判断超声波雷达存在误检。
若返回障碍物坐标的相邻超声波雷达的个数为一个,判断所述待判断超声波雷达的覆盖范围是否存在两个超声波雷达覆盖范围;
如果否,则认为所述超声波雷达阵列存在漏检,例如,超声波雷达一的覆盖范围为三个超声波雷达覆盖范围重叠,若仅有一个相邻超声波雷达二返回障碍物坐标;则其相邻的超声波雷达三或超声波雷达四应该返回障碍物坐标,若未返回,则其相邻的超声波雷达三或超声波雷达四存在漏检;
如果是,则进一步判断返回障碍物坐标的相邻超声波雷达的覆盖范围是否与所述待判断超声波雷达存在两个超声波雷达覆盖范围;
如果是,则不存在误检;例如,待判断超声波雷达九与相邻的超声波雷达七存在两个超声波雷达覆盖范围重叠,则障碍物位于该重叠区域;
如果否,则认为所述超声波雷达阵列存在漏检,例如,待判断超声波雷达七返回障碍物坐标,相邻的超声波雷达五返回障碍物坐标,而超声波雷达七与超声波雷达五仅存在三个超声波雷达覆盖范围重叠,则证明相邻的超声波雷达九或超声波雷达三存在漏检。
若返回障碍物坐标的相邻超声波雷达的个数为两个,则不认为所述待检测雷达存在误检。
进行漏检判断的规则如下:
若未接收到超声波雷达返回的障碍物坐标,判断待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标;
若所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标,则判断所述待判断超声波雷达不存在漏检;
若所述待判断超声波雷达的相邻超声波雷达返回障碍物坐标,
判断返回障碍物坐标的相邻超声波雷达的个数;
若返回障碍物坐标的相邻超声波雷达的个数为一个,判断所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围是否存在两个超声波雷达覆盖范围;
如果存在两个超声波雷达覆盖范围,则认为所述待判断超声波雷达存在漏检,例如,如障碍物位于超声波雷达七覆盖范围中的两个超声波雷达覆盖范围,即与超声波雷达九重叠的覆盖范围内,超声波雷达九未返回障碍物坐标,相邻的超声波雷达七返回障碍物坐标。为了安全起见,认为是超声波雷达九漏检。因为,如果误检,只可能造成无人驾驶车辆停车,等待下一时刻检测结果,如果是漏检,则很可能造成碰撞。
如果不存在两个超声波雷达覆盖范围,仅存在三个超声波雷达覆盖范围,由于三个超声波雷达中仅一个超声波雷达返回障碍物坐标,则认为所说实话返回障碍物坐标的超声波雷达存在误检,而待判断超声波雷达不存在漏检,例如,超声波雷达一未返回障碍物坐标,而其相邻的超声波雷达三、超声波雷达二都返回了障碍物坐标,超声波雷达一与超声波雷达三、超声波雷达二存在三个超声波雷达覆盖范围,则超声波雷达一为漏检。
若返回障碍物坐标的相邻超声波雷达的个数为两个,判断所述待检测超声波与所述返回障碍物坐标的两个相邻超声波雷达的覆盖范围是否存在三个超声波雷达覆盖范围;如果存在三个超声波雷达覆盖范围,则认为所述待判断超声波雷达存在漏检;如果不存在三个超声波雷达覆盖范围,则不认为所述待判断超声波雷达存在漏检。
若返回障碍物坐标的相邻超声波雷达的个数为三个或三个以上,则认为所述待判断超声波雷达存在漏检。
通过上述步骤,根据待判断超声波雷达与相邻超声波雷达覆盖范围的相互重叠情况以及超声波雷达阵列中各超声波雷达返回的障碍物坐标,对待判断超声波雷达的误检或漏检情况进行了判断。
步骤S23、根据所述判断结果所述超声波雷达阵列中的各超声波雷达采集的障碍物信息进行处理。
优选地,若所述检测结果存在误检,则删除所述误检的超声波雷达采集的障碍物信息。
优选地,若所述检测结果存在漏检,则可以根据其相邻超声波雷达返回的障碍物信息得到所述漏检的超声波雷达采集的障碍物信息。所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,以相邻超声波雷达返回的障碍物坐标作为所述待判断超声波雷达的障碍物坐标。所述待判断超声波雷达的两个及以上相邻超声波雷达返回障碍物坐标的情况下,采用基于三角测量的融合方法融合这两个超声波雷达返回的距离数据,作为所述待判断超声波雷达的障碍物坐标。
例如,若超声波雷达一未返回障碍物坐标,而其相邻的超声波雷达三、超声波雷达二都返回了障碍物坐标,则根据其超声波雷达三、超声波雷达二返回的障碍物坐标确定所述超声波雷达一对应的障碍物坐标。
若所述检测结果不存在误检或漏检,则不对所述超声波雷达阵列中的各超声波雷达采集的障碍物信息进行处理。
步骤S24、根据处理后的各超声波雷达采集的障碍物信息,确定障碍物在车体坐标系中的位置,根据所述障碍物的位置进行无人驾驶车辆决策。
优选地,若仅有单个超声波雷达返回障碍物坐标,则确定障碍物位于以所述单个超声波雷达为原点,以障碍物距离为半径的圆弧位于所述超声波雷达的单个超声波雷达覆盖范围的部分上个。
优选地,若有两个或两个以上相邻超声波雷达返回障碍物坐标,则采用基于三角测量的融合方法融合这两个超声波雷达返回的距离数据,获取障碍物的边缘定点信息。
优选地,若有三个或三个以上相邻超声波雷达返回障碍物坐标,由于采用三角测量的融合方法时融合次数较多,可以采用外接圆法进行融合处理,对于障碍物的同一个边缘点,理论上多个超声波雷达的以超声波雷达为原点,以障碍物距离为半径的圆弧应该相交于一点,但实际上由于测量误差、噪声干扰等原始使得多段圆弧并不交于一点。因此,以三个超声波雷达为一组,每组有三段圆弧相交于三点,取所述三点的外接圆圆心作为这三个超声波雷达的最终测量结果,最后求各组超声波雷达最终测量结果的平均值作为最终融合结果。
通过本申请所述实施例,可以有效判断超声波雷达阵列中各超声波雷达出现的误检和漏检,精确确定障碍物位置,提高了无人驾驶车辆的行驶安全性。
需要说明的是,对于前述的各方法实施例,为了简单描述,故将其都表述为一系列的动作组合,但是本领域技术人员应该知悉,本申请并不受所描述的动作顺序的限制,因为依据本申请,某些步骤可以采用其他顺序或者同时进行。其次,本领域技术人员也应该知悉,说明书中所描述的实施例均属于优选实施例,所涉及的动作和模块并不一定是本申请所必须的。
以上是关于方法实施例的介绍,以下通过装置实施例,对本发明所述方案进行进一步说明。
图3为本申请实施例二提供的超声波雷达阵列障碍物检测系统的结构示意图,如图3所示,包括:
获取模块31,用于获取如实施例一中所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息,并将各坐标转换到车体坐标系;
所述超声波雷达的初始空间配置是事先已知的,可以根据所述多个超声波雷达在无人驾驶车辆车体上的测量数据得到。将目标在各雷达坐标系中的坐标转换到车体坐标系中。
判断模块32,用于根据预设规则对所述超声波雷达阵列中的各超声波雷达采集的障碍物信息进行误检及漏检判断。
所述预设规则的基本原理是,当一个超声波雷达误检时,若其相邻超声波雷达未发生误检,将不返回障碍物坐标;当一个超声波雷达漏检时,若其相邻超声波雷达未发生漏检,将返回障碍物坐标。
进行误检判断的规则如下:
若接收到超声波雷达返回的障碍物坐标,判断待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标;
若所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标,则判断所述待判断超声波雷达是否存在单个超声波雷达覆盖范围,例如位于超声波雷达阵列边缘的超声波雷达九、超声波雷达十;
若所述待判断超声波雷达的覆盖范围存在单个超声波雷达覆盖范围,则认为障碍物出现在了所述待判断超声波雷达的单个超声波雷达覆盖范围内;所述待判断超声波雷达未出现误检;
若所述超声波雷达的覆盖范围存在两个超声波雷达覆盖范围,例如超声波雷达七、超声波雷达八,其检测范围至少与一个相邻超声波雷达覆盖范围重叠,如超声波雷达七返回障碍物坐标,而相邻的超声波雷达九未返回障碍物坐标、相邻的超声波雷达五也未返回障碍物坐标;这就存在多种可能,如障碍物位于超声波雷达七覆盖范围中的两个超声波雷达覆盖范围,即与超声波雷达九重叠的覆盖范围内,则可能是超声波雷达九漏检,也可能是超声波雷达七误检。如果障碍物位于超声波雷达七覆盖范围中的三个超声波雷达覆盖范围,即与超声波雷达九、超声波雷达五重叠的覆盖范围内,则由于超声波雷达九、超声波雷达五都未返回障碍物坐标,则可能是超声波雷达七误检。为了安全起见,认为障碍物位于超声波雷达七覆盖范围中的两个超声波雷达覆盖范围,即与超声波雷达九重叠的覆盖范围内,是超声波雷达九漏检。因为,如果误检,只可能造成无人驾驶车辆停车,等待下一时刻检测结果,如果是漏检,则很可能造成碰撞。
若所述超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,例如超声波雷达五、超声波雷达三、超声波雷达一、超声波雷达二、超声波雷达四、超声波雷达六,其检测范围与两个相邻超声波雷达覆盖范围重叠,在两个相邻超声波雷达都未返回障碍物检测结果的情况下,则认为所述待判断超声波雷达存在误检。
若返回障碍物坐标的相邻超声波雷达的个数为一个,判断所述待判断超声波雷达的覆盖范围是否存在两个超声波雷达覆盖范围;
如果否,则认为所述超声波雷达阵列存在漏检,例如,超声波雷达一的覆盖范围为三个超声波雷达覆盖范围重叠,若仅有一个相邻超声波雷达二返回障碍物坐标;则其相邻的超声波雷达三或超声波雷达四应该返回障碍物坐标,若未返回,则其相邻的超声波雷达三或超声波雷达四存在漏检;
如果是,则进一步判断返回障碍物坐标的相邻超声波雷达的覆盖范围是否与所述待判断超声波雷达存在两个超声波雷达覆盖范围;
如果是,则不存在误检;例如,待判断超声波雷达九与相邻的超声波雷达七存在两个超声波雷达覆盖范围重叠,则障碍物位于该重叠区域;
如果否,则认为所述超声波雷达阵列存在漏检,例如,待判断超声波雷达七返回障碍物坐标,相邻的超声波雷达五返回障碍物坐标,而超声波雷达七与超声波雷达五仅存在三个超声波雷达覆盖范围重叠,则证明相邻的超声波雷达九或超声波雷达三存在漏检。
若返回障碍物坐标的相邻超声波雷达的个数为两个,则不认为所述待检测雷达存在误检。
进行漏检判断的规则如下:
若未接收到超声波雷达返回的障碍物坐标,判断待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标;
若所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标,则判断所述待判断超声波雷达不存在漏检;
若所述待判断超声波雷达的相邻超声波雷达返回障碍物坐标,
判断返回障碍物坐标的相邻超声波雷达的个数;
若返回障碍物坐标的相邻超声波雷达的个数为一个,判断所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围是否存在两个超声波雷达覆盖范围;
如果存在两个超声波雷达覆盖范围,则认为所述待判断超声波雷达存在漏检,例如,如障碍物位于超声波雷达七覆盖范围中的两个超声波雷达覆盖范围,即与超声波雷达九重叠的覆盖范围内,超声波雷达九未返回障碍物坐标,相邻的超声波雷达七返回障碍物坐标。为了安全起见,认为是超声波雷达九漏检。因为,如果误检,只可能造成无人驾驶车辆停车,等待下一时刻检测结果,如果是漏检,则很可能造成碰撞。
如果不存在两个超声波雷达覆盖范围,仅存在三个超声波雷达覆盖范围,由于三个超声波雷达中仅一个超声波雷达返回障碍物坐标,则认为所说实话返回障碍物坐标的超声波雷达存在误检,而待判断超声波雷达不存在漏检,例如,超声波雷达一未返回障碍物坐标,而其相邻的超声波雷达三、超声波雷达二都返回了障碍物坐标,超声波雷达一与超声波雷达三、超声波雷达二存在三个超声波雷达覆盖范围,则超声波雷达一为漏检。
若返回障碍物坐标的相邻超声波雷达的个数为两个,判断所述待检测超声波与所述返回障碍物坐标的两个相邻超声波雷达的覆盖范围是否存在三个超声波雷达覆盖范围;如果存在三个超声波雷达覆盖范围,则认为所述待判断超声波雷达存在漏检;如果不存在三个超声波雷达覆盖范围,则不认为所述待判断超声波雷达存在漏检。
若返回障碍物坐标的相邻超声波雷达的个数为三个或三个以上,则认为所述待判断超声波雷达存在漏检。
通过上述步骤,根据待判断超声波雷达与相邻超声波雷达覆盖范围的相互重叠情况以及超声波雷达阵列中各超声波雷达返回的障碍物坐标,对待判断超声波雷达的误检或漏检情况进行了判断。
处理模块33,用于根据所述判断结果所述超声波雷达阵列中的各超声波雷达采集的障碍物信息进行处理。
优选地,若所述检测结果存在误检,则删除所述误检的超声波雷达采集的障碍物信息。
优选地,若所述检测结果存在漏检,则可以根据其相邻超声波雷达返回的障碍物信息得到所述漏检的超声波雷达采集的障碍物信息。所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,以相邻超声波雷达返回的障碍物坐标作为所述待判断超声波雷达的障碍物坐标。所述待判断超声波雷达的两个及以上相邻超声波雷达返回障碍物坐标的情况下,采用基于三角测量的融合方法融合这两个超声波雷达返回的距离数据,作为所述待判断超声波雷达的障碍物坐标。
例如,若超声波雷达一未返回障碍物坐标,而其相邻的超声波雷达三、超声波雷达二都返回了障碍物坐标,则根据其超声波雷达三、超声波雷达二返回的障碍物坐标确定所述超声波雷达一对应的障碍物坐标。
若所述检测结果不存在误检或漏检,则不对所述超声波雷达阵列中的各超声波雷达采集的障碍物信息进行处理。
确定模块34,用于根据处理后的各超声波雷达采集的障碍物信息,确定障碍物在车体坐标系中的位置,根据所述障碍物的位置进行无人驾驶车辆决策。
优选地,若仅有单个超声波雷达返回障碍物坐标,则确定障碍物位于以所述单个超声波雷达为原点,以障碍物距离为半径的圆弧位于所述超声波雷达的单个超声波雷达覆盖范围的部分上个。
优选地,若有两个或两个以上相邻超声波雷达返回障碍物坐标,则采用基于三角测量的融合方法融合这两个超声波雷达返回的距离数据,获取障碍物的边缘定点信息。
优选地,若有三个或三个以上相邻超声波雷达返回障碍物坐标,由于采用三角测量的融合方法时融合次数较多,可以采用外接圆法进行融合处理,对于障碍物的同一个边缘点,理论上多个超声波雷达的以超声波雷达为原点,以障碍物距离为半径的圆弧应该相交于一点,但实际上由于测量误差、噪声干扰等原始使得多段圆弧并不交于一点。因此,以三个超声波雷达为一组,每组有三段圆弧相交于三点,取所述三点的外接圆圆心作为这三个超声波雷达的最终测量结果,最后求各组超声波雷达最终测量结果的平均值作为最终融合结果。
通过本申请所述实施例,可以有效判断超声波雷达阵列中各超声波雷达出现的误检和漏检,精确确定障碍物位置,提高了无人驾驶车辆的行驶安全性。
在所述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
在本申请所提供的几个实施例中,应该理解到,所揭露的方法和装置,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。所述集成的单元既可以采用硬件的形式实现,也可以采用硬件加软件功能单元的形式实现。
图4示出了适于用来实现本发明实施方式的示例性计算机系统/服务器012的框图。图4显示的计算机系统/服务器012仅仅是一个示例,不应对本发明实施例的功能和使用范围带来任何限制。
如图4所示,计算机系统/服务器012以通用计算设备的形式表现。计算机系统/服务器012的组件可以包括但不限于:一个或者多个处理器或者处理单元016,系统存储器028,连接不同系统组件(包括系统存储器028和处理单元016)的总线018。
总线018表示几类总线结构中的一种或多种,包括存储器总线或者存储器控制器,外围总线,图形加速端口,处理器或者使用多种总线结构中的任意总线结构的局域总线。举例来说,这些体系结构包括但不限于工业标准体系结构(ISA)总线,微通道体系结构(MAC)总线,增强型ISA总线、视频电子标准协会(VESA)局域总线以及外围组件互连(PCI)总线。
计算机系统/服务器012典型地包括多种计算机系统可读介质。这些介质可以是任何能够被计算机系统/服务器012访问的可用介质,包括易失性和非易失性介质,可移动的和不可移动的介质。
系统存储器028可以包括易失性存储器形式的计算机系统可读介质,例如随机存取存储器(RAM)030和/或高速缓存存储器032。计算机系统/服务器012可以进一步包括其它可移动/不可移动的、易失性/非易失性计算机系统存储介质。仅作为举例,存储系统034可以用于读写不可移动的、非易失性磁介质(图4未显示,通常称为“硬盘驱动器”)。尽管图4中未示出,可以提供用于对可移动非易失性磁盘(例如“软盘”)读写的磁盘驱动器,以及对可移动非易失性光盘(例如CD-ROM,DVD-ROM或者其它光介质)读写的光盘驱动器。在这些情况下,每个驱动器可以通过一个或者多个数据介质接口与总线018相连。存储器028可以包括至少一个程序产品,该程序产品具有一组(例如至少一个)程序模块,这些程序模块被配置以执行本发明各实施例的功能。
具有一组(至少一个)程序模块042的程序/实用工具040,可以存储在例如存储器028中,这样的程序模块042包括——但不限于——操作系统、一个或者多个应用程序、其它程序模块以及程序数据,这些示例中的每一个或某种组合中可能包括网络环境的实现。程序模块042通常执行本发明所描述的实施例中的功能和/或方法。
计算机系统/服务器012也可以与一个或多个外部设备014(例如键盘、指向设备、显示器024等)通信,在本发明中,计算机系统/服务器012与外部雷达设备进行通信,还可与一个或者多个使得用户能与该计算机系统/服务器012交互的设备通信,和/或与使得该计算机系统/服务器012能与一个或多个其它计算设备进行通信的任何设备(例如网卡,调制解调器等等)通信。这种通信可以通过输入/输出(I/O)接口022进行。并且,计算机系统/服务器012还可以通过网络适配器020与一个或者多个网络(例如局域网(LAN),广域网(WAN)和/或公共网络,例如因特网)通信。如图4所示,网络适配器020通过总线018与计算机系统/服务器012的其它模块通信。应当明白,尽管图4中未示出,可以结合计算机系统/服务器012使用其它硬件和/或软件模块,包括但不限于:微代码、设备驱动器、冗余处理单元、外部磁盘驱动阵列、RAID系统、磁带驱动器以及数据备份存储系统等。
处理单元016通过运行存储在系统存储器028中的程序,从而执行本发明所描述的实施例中的功能和/或方法。
上述的计算机程序可以设置于计算机存储介质中,即该计算机存储介质被编码有计算机程序,该程序在被一个或多个计算机执行时,使得一个或多个计算机执行本发明上述实施例中所示的方法流程和/或装置操作。
随着时间、技术的发展,介质含义越来越广泛,计算机程序的传播途径不再受限于有形介质,还可以直接从网络下载等。可以采用一个或多个计算机可读的介质的任意组合。计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。计算机可读存储介质的更具体的例子(非穷举的列表)包括:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本文件中,计算机可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。
计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式,包括——但不限于——电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质,该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。
计算机可读介质上包含的程序代码可以用任何适当的介质传输,包括——但不限于——无线、电线、光缆、RF等等,或者上述的任意合适的组合。
可以以一种或多种程序设计语言或其组合来编写用于执行本发明操作的计算机程序代码,所述程序设计语言包括面向对象的程序设计语言—诸如Java、Smalltalk、C++,还包括常规的过程式程序设计语言—诸如“C”语言或类似的程序设计语言。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中,远程计算机可以通过任意种类的网络——包括局域网(LAN)或广域网(WAN)连接到用户计算机,或者,可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
最后应说明的是:以上实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围。

Claims (18)

1.一种超声波雷达阵列,其特征在于,包括:
均匀安装在无人驾驶车辆保险杠上的N个超声波雷达;其中,N为正整数;
所述N个超声波雷达从中央到外侧,向外旋转角度逐渐增大;其中,
所述超声波雷达的个数N及向外逐渐增大的旋转角度α为根据每个超声波雷达的探测距离及探测形状的数学模型确定的,以保证超声波雷达的覆盖范围存在三重冗余。
2.根据权利要求1所述的超声波雷达阵列,其特征在于,
若N为偶数,则第一超声波雷达水平安装于保险杠中央左侧,第二超声波雷达水平安装于保险杠中央右侧;(N-2)/2个超声波雷达安装于第一超声波雷达左侧,从中央到外侧,以上一个超声波雷达为基准,依次逆时针旋转α;(N-2)/2个超声波雷达安装于第二超声波雷达右侧,从中央到外侧,以上一个超声波雷达为基准,依次顺时针旋转α;
若N为奇数,则第一超声波雷达水平安装于保险杠中央,(N-1)/2个超声波雷达安装于第一超声波雷达左侧,从中央到外侧,以上一个超声波雷达为基准,依次逆时针旋转α;(N-1)/2个超声波雷达安装于第一超声波雷达右侧,从中央到外侧,以上一个超声波雷达为基准,依次顺时针旋转α。
3.一种根据权利要求1-2所述超声波雷达阵列的障碍物检测方法,其特征在于,包括:
获取所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息;
根据预设规则对各超声波雷达采集的障碍物信息进行误检及漏检判断;
根据所述判断结果对各超声波雷达采集的障碍物信息进行处理;
根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置。
4.根据权利要求3所述的方法,其特征在于,所述预设规则为根据待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标判断所述待判断超声波雷达是否存在误检及漏检。
5.根据权利要求4所述的方法,其特征在于,所述相邻超声波雷达为与所述待判断超声波雷达两侧的超声波雷达和间隔一个的超声波雷达。
6.根据权利要求5所述的方法,其特征在于,进行误检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,若所述待判断超声波雷达的覆盖范围存在单个超声波雷达覆盖范围或两个超声波雷达覆盖范围重叠,则不存在误检;若所述待判断超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则存在误检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,不存在误检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,不存在误检。
7.根据权利要求5所述的方法,其特征在于,进行漏检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,所述待判断超声波雷达不存在漏检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在两个超声波雷达覆盖范围重叠,则存在漏检;若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在三个超声波雷达覆盖范围,则存在漏检;若不存在三个超声波雷达覆盖范围重叠则不存在漏检;
所述待判断超声波雷达的三个及以上相邻超声波雷达返回障碍物坐标的情况下,存在漏检。
8.根据权利要求3所述的方法,其特征在于,根据所述判断结果对各超声波雷达采集的障碍物信息进行处理包括:
若所述超声波雷达采集的障碍物信息存在误检,则删除所述误检的超声波雷达采集的障碍物信息;
若所述超声波雷达采集的障碍物信息存在漏检,根据其相邻超声波雷达返回的障碍物信息得到所述漏检的超声波雷达采集的障碍物信息。
9.根据权利要求8所述的方法,其特征在于,根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置包括:
融合多个超声波雷达返回的距离数据,获取障碍物的坐标。
10.一种根据权利要求1-2所述超声波雷达阵列的障碍物检测系统,其特征在于,包括:
获取模块,用于获取所述超声波雷达阵列中各超声波雷达在障碍物场景中采集的障碍物信息;
判断模块,用于根据预设规则对各超声波雷达采集的障碍物信息进行误检及漏检判断;
处理模块,用于根据所述判断结果对各超声波雷达采集的障碍物信息进行处理;
确定模块,用于根据处理后的各超声波雷达采集的障碍物信息,确定障碍物位置。
11.根据权利要求10所述的系统,其特征在于,所述预设规则为根据待判断超声波雷达的相邻超声波雷达是否返回障碍物坐标判断所述待判断超声波雷达是否存在误检及漏检。
12.根据权利要求11所述的系统,其特征在于,所述相邻超声波雷达为与所述待判断超声波雷达两侧的超声波雷达和间隔一个的超声波雷达。
13.根据权利要求12所述的系统,其特征在于,进行误检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,若所述待判断超声波雷达的覆盖范围存在单个超声波雷达覆盖范围或两个超声波雷达覆盖范围重叠,则不存在误检;若所述待判断超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则存在误检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,不存在误检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,不存在误检。
14.根据权利要求12所述的系统,其特征在于,进行漏检判断的预设规则包括:
所述待判断超声波雷达的相邻超声波雷达未返回障碍物坐标的情况下,所述待判断超声波雷达不存在漏检;
所述待判断超声波雷达的一个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在两个超声波雷达覆盖范围重叠,则存在漏检;若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围仅存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的两个相邻超声波雷达返回障碍物坐标的情况下,若所述待判断超声波雷达与所述返回障碍物坐标的相邻超声波雷达的覆盖范围存在三个超声波雷达覆盖范围,则存在漏检;若不存在三个超声波雷达覆盖范围重叠,则不存在漏检;
所述待判断超声波雷达的三个及以上相邻超声波雷达返回障碍物坐标的情况下,存在漏检。
15.根据权利要求10所述的系统,其特征在于,所述处理模块具体用于:
若所述超声波雷达采集的障碍物信息存在误检,则删除所述误检的超声波雷达采集的障碍物信息;
若所述超声波雷达采集的障碍物信息存在漏检,根据其相邻超声波雷达返回的障碍物信息得到所述漏检的超声波雷达采集的障碍物信息。
16.根据权利要求15所述的系统,其特征在于,所述确定模块具体用于:
融合多个超声波雷达返回的距离数据,获取障碍物的坐标。
17.一种计算机设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求3~9中任一项所述的方法。
18.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时实现如权利要求3~9中任一项所述的方法。
CN201910036318.8A 2019-01-15 2019-01-15 一种超声波雷达阵列、障碍物检测方法及系统 Active CN109765563B (zh)

Priority Applications (5)

Application Number Priority Date Filing Date Title
CN201910036318.8A CN109765563B (zh) 2019-01-15 2019-01-15 一种超声波雷达阵列、障碍物检测方法及系统
PCT/CN2019/127358 WO2020147518A1 (zh) 2019-01-15 2019-12-23 一种超声波雷达阵列、障碍物检测方法及系统
EP19910464.7A EP3842834A4 (en) 2019-01-15 2019-12-23 ULTRASONIC RADAR ARRANGEMENT AND OBSTACLE DETECTION METHOD AND SYSTEM
US17/278,646 US11933893B2 (en) 2019-01-15 2019-12-23 Ultrasonic radar array, and obstacle detection method and system
JP2020570048A JP2021526649A (ja) 2019-01-15 2019-12-23 超音波レーダアレイ、障害物検出方法、デバイス、記憶媒体、プログラム及びシステム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910036318.8A CN109765563B (zh) 2019-01-15 2019-01-15 一种超声波雷达阵列、障碍物检测方法及系统

Publications (2)

Publication Number Publication Date
CN109765563A CN109765563A (zh) 2019-05-17
CN109765563B true CN109765563B (zh) 2021-06-11

Family

ID=66452246

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910036318.8A Active CN109765563B (zh) 2019-01-15 2019-01-15 一种超声波雷达阵列、障碍物检测方法及系统

Country Status (5)

Country Link
US (1) US11933893B2 (zh)
EP (1) EP3842834A4 (zh)
JP (1) JP2021526649A (zh)
CN (1) CN109765563B (zh)
WO (1) WO2020147518A1 (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109765563B (zh) * 2019-01-15 2021-06-11 北京百度网讯科技有限公司 一种超声波雷达阵列、障碍物检测方法及系统
CN110161510B (zh) * 2019-06-27 2021-12-10 北京智行者科技有限公司 基于超声波雷达的障碍物定位方法及装置
WO2021092722A1 (zh) * 2019-11-11 2021-05-20 深圳市大疆创新科技有限公司 雷达组件、无人机、障碍物检测方法、设备及存储介质
CN113156445B (zh) * 2021-05-11 2023-10-20 东风汽车集团股份有限公司 一种超声波雷达盲区监测系统及监测方法
TWI795006B (zh) * 2021-09-30 2023-03-01 台灣立訊精密有限公司 圖形化超音波模組及駕駛輔助系統

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06324258A (ja) * 1993-05-13 1994-11-25 Fuji Photo Optical Co Ltd パッシブ型オートフォーカス装置用測距装置
CN1808177A (zh) * 2005-01-20 2006-07-26 株式会社日立制作所 车载雷达
CN105116389A (zh) * 2015-09-08 2015-12-02 中船重工鹏力(南京)大气海洋信息系统有限公司 一种基于硬限幅脉压的雷达双通道抗同频干扰方法
EP2569650B1 (de) * 2010-05-11 2016-07-20 Robert Bosch GmbH Verfahren und vorrichtung zur bestimmung der position eines objektes relativ zu einem fahrzeug, insbesondere einem kraftfahrzeug, zur verwendung in einem fahrerassistenzsystem des fahrzeuges
CN106772396A (zh) * 2016-12-12 2017-05-31 成都育芽科技有限公司 一种自动避障无人机
CN108872991A (zh) * 2018-05-04 2018-11-23 上海西井信息科技有限公司 目标物检测与识别方法、装置、电子设备、存储介质
CN109050398A (zh) * 2018-08-20 2018-12-21 深圳市路畅智能科技有限公司 一种汽车低速行驶安全预警方法
CN109087481A (zh) * 2018-10-19 2018-12-25 福建工程学院 一种危险超车警报方法、系统以及大型车辆

Family Cites Families (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4803670A (en) * 1987-07-07 1989-02-07 Li-Ling Lin Ultrasonic ranging device
US5389912A (en) * 1993-02-10 1995-02-14 Arvin; Parham P. Truck clearance anti-collision device
DE102006019833B4 (de) * 2005-05-10 2013-04-11 Denso Corporation Einrichtung zur Entdeckung eines Hindernisses
DE102006007173A1 (de) * 2006-02-08 2007-08-09 Valeo Schalter Und Sensoren Gmbh Fahrzeugumfelderkennungssystem, insbesondere zur Erkennung von seitlich auf das Fahrzeug zukommenden Objekten und/oder zukommendem Kreuzungsverkehrs sowie Verfahren hierfür
JP4753765B2 (ja) 2006-03-30 2011-08-24 ダイハツ工業株式会社 障害物認識方法
CN101169479B (zh) * 2006-10-23 2012-07-04 李世雄 防止误判断的倒车雷达及其方法
DE102007029959A1 (de) 2007-06-28 2009-01-02 Robert Bosch Gmbh Verfahren und Vorrichtung zur Erfassung einer Umgebung
DE102008007667A1 (de) * 2007-12-21 2009-06-25 Robert Bosch Gmbh Verfahren zum Betreiben eines Einparkhilfesystems
WO2011129001A1 (ja) * 2010-04-15 2011-10-20 パナソニック電工株式会社 障害物検出システム
US8384533B2 (en) * 2010-04-20 2013-02-26 Whetron Electronics Co., Ltd. Hostless automobile reverse radar warning system
CN101900814B (zh) * 2010-07-09 2012-09-05 深圳市豪恩电子科技股份有限公司 倒车雷达系统及倒车雷达探测方法
DE102011013681A1 (de) 2011-03-11 2012-09-13 Valeo Schalter Und Sensoren Gmbh Verfahren zum Detektieren einer Parklücke, Parkhilfesystem und Kraftfahrzeug mit einem Parkhilfesystem
DE102011102557A1 (de) * 2011-05-26 2012-11-29 Valeo Schalter Und Sensoren Gmbh Fahrerassistenzeinrichtung mit einer Mehrzahl von Ultraschallsensoren sowie Fahrzeug mit einer derartigen Fahrerassistenzeinrichtung und Verfahren zum Betreiben einer Fahrerassistenzeinrichtung
CN102385056B (zh) * 2011-08-11 2013-10-30 西北工业大学 一种基于多超声波传感器的导盲避碰装置
JP6019959B2 (ja) 2012-09-06 2016-11-02 富士通株式会社 物体検出装置、物体検出プログラムおよび車両
DE102013200793A1 (de) * 2013-01-18 2014-07-24 Robert Bosch Gmbh Fahrerassistenzsystem
US20150268341A1 (en) * 2014-03-21 2015-09-24 Ford Global Technologies, Llc Object detection using ultrasonic phase arrays
DE102016100732B4 (de) * 2016-01-18 2023-09-21 Valeo Schalter Und Sensoren Gmbh Verfahren zum Betreiben eines Ultraschallsensors eines Kraftfahrzeugs. Ultraschallsensorvorrichtung, Fahrerassistenzsystem sowie Kraftfahrzeug
CN106314327A (zh) * 2016-08-30 2017-01-11 陈武强 防地面误测误报的汽车超声波盲区探测装置及探测方法
JP2018048839A (ja) 2016-09-20 2018-03-29 ファナック株式会社 三次元データ生成装置及び三次元データ生成方法、並びに三次元データ生成装置を備えた監視システム
DE102016118959B4 (de) * 2016-10-06 2018-05-03 Valeo Schalter Und Sensoren Gmbh Kraftfahrzeug mit einem Umgebungsüberwachungssystem mit mindestens zwei Ultraschallsensoren, deren Erfassungsbereiche sich überlappen, zum Erfassen einer Umgebung des Kraftfahrzeugs
CN106681319A (zh) 2016-12-09 2017-05-17 重庆长安汽车股份有限公司 自动换道系统及方法
JP6914065B2 (ja) * 2017-03-17 2021-08-04 シャープ株式会社 障害物検出装置、走行装置、障害物検出システムおよび障害物検出方法
DE102017108348B3 (de) * 2017-04-20 2018-06-21 Valeo Schalter Und Sensoren Gmbh Konfiguration eines Sensorsystems mit einem neuronalen Netzwerk für ein Kraftfahrzeug
CN206900319U (zh) * 2017-06-22 2018-01-19 北汽福田汽车股份有限公司 一种汽车及其雷达布置结构
CN207216423U (zh) * 2017-09-11 2018-04-10 河南森源电气股份有限公司 一种基于全方位超声波避障系统的agv导航车
CN107966700A (zh) * 2017-11-20 2018-04-27 天津大学 一种用于无人驾驶汽车的前方障碍物检测系统及方法
CN107957583A (zh) * 2017-11-29 2018-04-24 江苏若博机器人科技有限公司 一种多传感器融合全天候快速无人车探测避障系统
CN108037515A (zh) * 2017-12-27 2018-05-15 清华大学苏州汽车研究院(吴江) 一种激光雷达和超声波雷达信息融合系统及方法
CN108333589A (zh) * 2018-03-13 2018-07-27 苏州青飞智能科技有限公司 一种自动驾驶车辆障碍物检测装置
CN108828527B (zh) 2018-06-19 2021-04-16 驭势(上海)汽车科技有限公司 一种多传感器数据融合方法、装置、车载设备及存储介质
CN109634282B (zh) * 2018-12-25 2021-05-28 奇瑞汽车股份有限公司 自动驾驶车辆、方法和装置
CN109765563B (zh) * 2019-01-15 2021-06-11 北京百度网讯科技有限公司 一种超声波雷达阵列、障碍物检测方法及系统
CN114280623A (zh) * 2019-01-15 2022-04-05 北京百度网讯科技有限公司 一种超声波雷达阵列、障碍物检测方法及系统

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06324258A (ja) * 1993-05-13 1994-11-25 Fuji Photo Optical Co Ltd パッシブ型オートフォーカス装置用測距装置
CN1808177A (zh) * 2005-01-20 2006-07-26 株式会社日立制作所 车载雷达
EP2569650B1 (de) * 2010-05-11 2016-07-20 Robert Bosch GmbH Verfahren und vorrichtung zur bestimmung der position eines objektes relativ zu einem fahrzeug, insbesondere einem kraftfahrzeug, zur verwendung in einem fahrerassistenzsystem des fahrzeuges
CN105116389A (zh) * 2015-09-08 2015-12-02 中船重工鹏力(南京)大气海洋信息系统有限公司 一种基于硬限幅脉压的雷达双通道抗同频干扰方法
CN106772396A (zh) * 2016-12-12 2017-05-31 成都育芽科技有限公司 一种自动避障无人机
CN108872991A (zh) * 2018-05-04 2018-11-23 上海西井信息科技有限公司 目标物检测与识别方法、装置、电子设备、存储介质
CN109050398A (zh) * 2018-08-20 2018-12-21 深圳市路畅智能科技有限公司 一种汽车低速行驶安全预警方法
CN109087481A (zh) * 2018-10-19 2018-12-25 福建工程学院 一种危险超车警报方法、系统以及大型车辆

Also Published As

Publication number Publication date
WO2020147518A1 (zh) 2020-07-23
JP2021526649A (ja) 2021-10-07
EP3842834A1 (en) 2021-06-30
US11933893B2 (en) 2024-03-19
CN109765563A (zh) 2019-05-17
US20220043145A1 (en) 2022-02-10
EP3842834A4 (en) 2021-09-15

Similar Documents

Publication Publication Date Title
CN109765563B (zh) 一种超声波雷达阵列、障碍物检测方法及系统
CN109814114B (zh) 一种超声波雷达阵列、障碍物检测方法及系统
CN109059902B (zh) 相对位姿确定方法、装置、设备和介质
CN109188438B (zh) 偏航角确定方法、装置、设备和介质
CN109284348B (zh) 一种电子地图的更新方法、装置、设备和存储介质
JP2021526278A (ja) 情報処理方法、システム、デバイス、プログラム及びコンピュータ記憶媒体
CN109814113B (zh) 一种超声波雷达障碍物检测结果处理方法及系统
CN112015178B (zh) 一种控制方法、装置、设备及存储介质
CN108859952B (zh) 车辆变道预警方法、装置和雷达
CN110632617A (zh) 一种激光雷达点云数据处理的方法及装置
CN113391305B (zh) 多雷达融合的虚假目标抑制方法、装置及终端设备
EP4012452A1 (en) Method and system for determining position of obstacle, computer device, and storage medium
CN111580116A (zh) 一种车载系统的目标检测性能的评价方法和电子设备
CN110542421B (zh) 机器人定位方法、定位装置、机器人及存储介质
CN108693517B (zh) 车辆定位方法、装置和雷达
CN112689842B (zh) 一种目标检测方法以及装置
CN108732588A (zh) 一种雷达扫描装置、方法以及设备
CN110133624B (zh) 无人驾驶异常检测方法、装置、设备和介质
CN114167393A (zh) 交通雷达的位置标定方法及装置、存储介质、电子设备
CN113570622A (zh) 一种障碍物确定方法、装置、电子设备以及存储介质
CN113391289A (zh) 一种雷达虚假目标抑制方法、装置及终端设备
CN111077527A (zh) 一种障碍物距离确定方法、装置、车载设备及存储介质
CN114216412B (zh) 一种交通参与者的角度信息获取方法、装置和存储介质
WO2024060790A1 (zh) 提高目标探测精度的方法和装置、电子设备
CN117269963A (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
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20211022

Address after: 105 / F, building 1, No. 10, Shangdi 10th Street, Haidian District, Beijing 100085

Patentee after: Apollo Intelligent Technology (Beijing) Co.,Ltd.

Address before: 2 / F, baidu building, 10 Shangdi 10th Street, Haidian District, Beijing 100085

Patentee before: BEIJING BAIDU NETCOM SCIENCE AND TECHNOLOGY Co.,Ltd.

TR01 Transfer of patent right