CN103913748B - 一种基于多传感器的汽车感知***及感知方法 - Google Patents
一种基于多传感器的汽车感知***及感知方法 Download PDFInfo
- Publication number
- CN103913748B CN103913748B CN201410080250.0A CN201410080250A CN103913748B CN 103913748 B CN103913748 B CN 103913748B CN 201410080250 A CN201410080250 A CN 201410080250A CN 103913748 B CN103913748 B CN 103913748B
- Authority
- CN
- China
- Prior art keywords
- sensor
- laser radar
- ultrasonic sensor
- ultrasonic
- distance
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/86—Combinations of sonar systems with lidar systems; Combinations of sonar systems with systems not using wave reflection
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar 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)
- Acoustics & Sound (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
一种基于多传感器的汽车感知***及感知方法,汽车感知***包括设置在汽车车身四个面的多个超声波传感器、微控制单元MCU,设置在汽车车顶的四路伺服舵机和四路一维激光雷达;所述超声波传感器与微控制单元MCU通过I2C总线连接,四路伺服舵机和四路一维激光雷达与微控制单元MCU分别连接,伺服舵机通过转轴和四路一维激光雷达连接。该***通过结合超声波传感器和激光雷达二个优先级别的传感器,采用二级关系保证汽车行驶过程中最大限度保证检测的实时性;通过本***,无需使用三维激光扫描***,具有成本低可靠性好的特点。
Description
技术领域
本发明涉及车辆工程领域,尤其涉及一种基于多传感器的汽车感知***及感知方法。
背景技术
随着社会的发展,交通安全问题越来越凸显,传统的汽车安全理念也在逐渐发生变化,传统的安全理念很被动比如安全带、安全气囊、保险杠等多是些被动的方法并不能有效解决交通事故的发生,随着科技的进步,汽车的安全被细化,目前汽车安全分为主动安全、被动安全两种概念。被动安全技术和主动安全技术是保证汽车乘员安全的重要保障。过去,汽车安全设计主要考虑被动安全***,如设置安全带、安全气囊、保险杠等。现在汽车设计师们更多考虑的则是主动安全设计,使汽车能够主动采取措施,避免事故的发生。在这种汽车上装有汽车规避***,包括装在车身各部位的防撞雷达、多普勒雷达、红外雷达等传感器、盲点探测器等设施,由计算机进行控制。在超车、倒车、换道、大雾、雨天等易发生危险的情况下随时以声、光形式向驾驶员提供汽车周围必要的信息,并可自动采取措施,有效防止事故发生。
在主动安全***所采用的测距防撞传感器中,超声波测距传感器具有低成本,高可靠性等优点,因此受到了广大汽车车主的欢迎,在其用于汽车倒车辅助雷达的产品更是占据了汽车倒车雷达的相当大的一部份市场。 另外,激光测距传感器具有信号集中,测量距离远,测量精度高等优点,目前市场上的车载激光雷达是指载三维激光扫描仪,是一种移动型三维激光扫描***,是目前城市建模的最有效的工具之一。但是这种激光传感器成本高,不具有推广价值,本设计采用低成本的一维激光雷达,扫描频率比较慢,但是通过和超声波传感器阵列和伺服舵机构成二个优先级的感知***能很好避免其弊端。
这种设计需要根据车长、车宽和所能接受的测量盲区范围,确定超声波传感器的个数,超声波传感器个数越多,盲区可以做得越小,超声波传感器实现的近距离方位测量也会越精确,但是会使得超声波阵列的检测周期变长,并不利于障碍物的实时测量。采用测量盲区为30cm进行设计,可以很好地保证测量周期短和方位信息准确;激光雷达选择4路一维激光雷达,利用4路伺服舵机分别控制保证了每个激光雷达能够测量0-90°范围的任意角度的障碍物,通过舵机的PWM值反馈障碍物的角度信息,激光雷达测得值作为距离信息。
本设计技术的难点在于如何通过超声波阵列确定障碍物的方位,在确定了0-7米范围内的障碍物的大致方位后,激光传感器才能最迅速的准确的进行定位和精确的测量;另外,如何将激光雷达和超声波传感器阵列实现方位融合,只有两者方位完全一致,方能在最后显示屏上准确的显示出障碍物的方位。
发明内容
本发明要解决的技术问题在于针对现有技术中的缺陷,提供一种基于多传感器的汽车感知***及感知方法,能准确显示出汽车车身周边障碍物的方位和距离。
本发明解决其技术问题所采用的技术方案是:一种基于多传感器的汽车感知***,其特征在于,包括设置在汽车车身四个面的多个超声波传感器、微控制单元MCU,设置在汽车车顶的四路伺服舵机和四路一维激光雷达;所述超声波传感器与微控制单元MCU通过I2C总线连接,四路伺服舵机和四路一维激光雷达与微控制单元MCU分别连接,伺服舵机通过转轴和四路一维激光雷达连接。
按上述方案,所述超声波传感器的设置条件为:两个传感器之间最小距离为,车身四个面需要传感器总个数为;其中为超声波传感器的检测盲区, 为超声波传感器的最大检测角,为车宽, 为车长。
上述基于多传感器的汽车感知***的感知方法,包括以下步骤:
(1)根据驾驶车型的体积和所能接受超声波传感器最小的检测盲区确定设置在汽车车身四个面的超声波传感器的个数,并对超声波传感器进行编号;
(2)确定多个超声波传感器组成的超声波传感器阵列的轮询检测的控制策略和控制最小时间周期;
(3)通过超声波阵列所反馈的障碍物距离信息和传感器编号确定障碍物所在的大致方位和距离;
(4)微控制单元MCU根据接收的超声波传感器反馈的方位和距离信息进行计算,根据计算结果控制伺服舵机控制激光雷达进行精确定位;
(5)对激光雷达和超声波传感器阵列返回微控制单元MCU的信息进行比较,若两者返回方位及距离数据相符,则显示扫描信息,否则,通过伺服舵机微调激光雷达扫描角度,转入步骤(4);
(6)激光雷达在近距离定位完成后在各自0至90°的方位范围内进行逐度扫描,获取远距离障碍物定位信息。
按上述方案,所述步骤(2)中确定轮询检测的控制策略和控制最小时间周期的方法为:
以车体某一面传感器个数为M计算,由于每个超声波传感器具有波束角θ,在传感器能测量的最大半径L米的地方可能有X个传感器的测量区域重叠,那么有M/X个传感器发射和接收超声波信号相互不影响,那么传感器编号为1,X+1,2X+1……的传感器可以同时工作;根据外界条件可以知道声速为V,以最大测量距离可以算出一次测量周期时间长度不短于t=2* R/V=14/V, R为测距范围,通常设为7米;那么车体这一面的传感器全部完成一次发射和接收总时间周期为T=X*t=14X/V。
按上述方案,所述步骤(3)中确定障碍物所在的大致方位和距离的具体步骤为:
传感器进行车身周边障碍物扫描,传感器编号为n,n+1,n+2…n+m (m<X)都得到一个测量距离,其中最小测量距离为Lsmin,则其距车身周边距离为Lsmin,可以通过查表的方式确定此障碍物的方位,所述表的制定按照超声波传感器测量的某一距离和这一距离所覆盖的范围确定。
按上述方案,所述步骤(4)中MCU通过使用数字PID控制方式改变伺服舵机PWM的脉冲宽度比,使伺服舵机迅速精确的摆到相应位置进行测量,使用的数字PID算法:
。
按上述方案,步骤(6)中所述近距离为距车身0至7米范围,远距离为距车身7至60米范围。
本发明产生的有益效果是:
(1)在汽车周身7米范围内的障碍物需要迅速、精确的测量,定义为一级测量区,7米到60米范围内的障碍物可以逐度扫描,定义为二级测量区,本发明方法通过结合二个优先级别的传感器,采用二级关系保证汽车行驶过程中最大限度保证检测的实时性;
(2)通过本发明方法,无需使用三维激光扫描***,具有成本低可靠性好的特点。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1 是本发明的方法流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
一种基于多传感器的汽车感知***,包括设置在汽车车身四个面的多个超声波传感器、微控制单元MCU,设置在汽车车顶的四路伺服舵机和四路一维激光雷达;所述超声波传感器与微控制单元MCU通过I2C总线连接,四路伺服舵机和四路一维激光雷达与微控制单元MCU分别连接,伺服舵机通过转轴和四路一维激光雷达连接。设超声波传感器的检测盲区为,最大检测角为,那么两个传感器之间若要保证最大盲区不大于的最小距离为,设定车宽为,车长为,考虑车身一面需要传感器个数,则四个面需要传感器总个数为。
使用以上基于多传感器的汽车感知***的感知方法,包括以下步骤,方法流程图如图1所示:
(1)根据驾驶车型的体积和所能接受超声波传感器最小的检测盲区确定设置在汽车车身四个面的超声波传感器的个数,并对超声波传感器进行编号;
(2)确定多个超声波传感器组成的超声波传感器阵列的轮询检测的控制策略和控制最小时间周期;
(3)通过超声波阵列所反馈的障碍物距离信息和传感器编号确定障碍物所在的大致方位和距离;传感器进行车身周边障碍物扫描,传感器编号为n,n+1,n+2…n+m (m<X)都得到一个测量距离,其中最小测量距离为Lsmin,则其距车身周边距离为Lsmin,可以通过查表的方式确定此障碍物的方位,所述表的制定按照超声波传感器测量的某一距离和这一距离所覆盖的范围确定。
(4)微控制单元MCU根据接收的超声波传感器反馈的方位和距离信息进行计算,根据计算结果控制伺服舵机控制激光雷达进行精确定位;
得到车身周边超声波传感器返回的障碍物位置信息,由于超声波传感器波束角比较大,定位并不精准,MCU可以调用车顶上激光雷达迅速进行定位,车顶激光雷达为一维点状激光测距雷达,与伺服舵机轴连, MCU通过计算得到障碍物位置在车身一侧以车中心为轴,正前方为正方向的夹角约为处,设置角度偏差对应的占空比值,使用数字PID算法。通过使用数字PID控制方式可以改变PWM的脉冲宽度比使伺服舵机迅速精确的摆到相应位置进行测量。
(5)对激光雷达和超声波传感器阵列返回微控制单元MCU的信息进行比较,若相符,则显示扫描信息,否则,通过伺服舵机微调激光雷达扫描角度,转入步骤(4);
(6)激光雷达在0至7米范围定位完成后在各自0至90°的方位范围内进行逐度扫描,获取距车身7至60米范围障碍物定位信息。
在汽车周身7米范围内的障碍物需要迅速、精确的测量,定义为一级测量区,7米到60米范围内的障碍物可以逐度扫描,定义为二级测量区,本方法通过结合二个优先级别的传感器,采用二级关系保证汽车行驶过程中最大限度保证检测的实时性。
(7)在得到了需要的距离测量值后,通过显示器显示在以汽车中心为中心坐标,360度范围内,距离60米范围内的实时障碍物距离和方位显示图。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。
Claims (4)
1.一种基于多传感器的汽车感知***的感知方法,所述汽车感知***包括设置在汽车车身四个面的多个超声波传感器、微控制单元MCU,设置在汽车车顶的四路伺服舵机和四路一维激光雷达;所述超声波传感器与微控制单元MCU通过I2C总线连接,四路伺服舵机和四路一维激光雷达与微控制单元MCU分别连接,伺服舵机通过转轴和四路一维激光雷达连接;其中所述超声波传感器的设置条件为:两个传感器之间最小距离为车身四个面需要传感器总个数为N=(2(Lw+L1)/Lmin-4);其中Lun为超声波传感器的检测盲区,θ为超声波传感器的最大检测角,Lw为车宽,L1为车长;
其特征在于,包括以下步骤:
(1)根据驾驶车型的体积和所能接受超声波传感器最小的检测盲区确定设置在汽车车身四个面的超声波传感器的个数,并对超声波传感器进行编号;
(2)确定多个超声波传感器组成的超声波传感器阵列的轮询检测的控制策略和控制最小时间周期;
(3)通过超声波阵列所反馈的障碍物距离信息和传感器编号确定障碍物所在的大致方位和距离;
(4)微控制单元MCU根据接收的超声波传感器反馈的方位和距离信息进行计算,根据计算结果控制伺服舵机控制激光雷达进行精确定位;
(5)对激光雷达和超声波传感器阵列返回微控制单元MCU的信息进行比较,若两者方位和距离数据相符,则显示扫描信息;否则,通过伺服舵机微调激光雷达扫描角度,转入步骤(4);
(6)激光雷达在近距离定位完成后在各自0至90°的方位范围内进行逐度扫描,获取远距离障碍物定位信息。
2.根据权利要求1所述的感知方法,其特征在于,所述步骤(2)中确定轮询检测的控制策略和控制最小时间周期的方法为:
以车体某一面传感器个数为M计算,由于每个超声波传感器具有波束角θ,在传感器能测量的最大半径L米的地方可能有X个传感器的测量区域重叠,那么有M/X个传感器发射和接收超声波信号相互不影响,那么传感器编号为1,X+1,2X+1……的传感器可以同时工作;根据外界条件可以知道声速为V,以最大测量距离可以算出一次测量周期时间长度不短于t=2*R/V=14/V,R为测距范围,通常设为7米;那么车体这一面的传感器全部完成一次发射和接收总时间周期为T=X*t=14X/V。
3.根据权利要求2所述的感知方法,其特征在于,所述步骤(3)中确定障碍物所在的大致方位和距离的具体步骤为:
传感器进行车身周边障碍物扫描,传感器编号为n,n+1,n+2…n+m,其中m<X,都得到一个测量距离,其中最小测量距离为Lsmin,则其距车身周边距离为Lsmin,可以通过查表的方式确定此障碍物的方位,所述表的制定按照超声波传感器测量的某一距离和这一距离所覆盖的范围确定。
4.根据权利要求1所述的感知方法,其特征在于,步骤(6)中所述近距离为距车身0至7米范围,远距离为距车身7至60米范围。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410080250.0A CN103913748B (zh) | 2014-03-06 | 2014-03-06 | 一种基于多传感器的汽车感知***及感知方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410080250.0A CN103913748B (zh) | 2014-03-06 | 2014-03-06 | 一种基于多传感器的汽车感知***及感知方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103913748A CN103913748A (zh) | 2014-07-09 |
CN103913748B true CN103913748B (zh) | 2017-03-08 |
Family
ID=51039574
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410080250.0A Active CN103913748B (zh) | 2014-03-06 | 2014-03-06 | 一种基于多传感器的汽车感知***及感知方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103913748B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104535061A (zh) * | 2015-01-06 | 2015-04-22 | 常州先进制造技术研究所 | 一种基于多传感器数据融合的导航*** |
CN104678402B (zh) * | 2015-03-24 | 2017-07-28 | 安徽江淮汽车集团股份有限公司 | 一种泊车辅助的雷达调度方法 |
JP6975945B2 (ja) * | 2016-02-24 | 2021-12-01 | パナソニックIpマネジメント株式会社 | 判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体 |
CN105667402A (zh) * | 2016-03-21 | 2016-06-15 | 吉林大学 | 挂车倒车辅助*** |
CN106314327A (zh) * | 2016-08-30 | 2017-01-11 | 陈武强 | 防地面误测误报的汽车超声波盲区探测装置及探测方法 |
CN106707297B (zh) * | 2016-11-08 | 2023-09-01 | 上海禾赛科技有限公司 | 大视场车载激光雷达及车辆 |
JP6914065B2 (ja) * | 2017-03-17 | 2021-08-04 | シャープ株式会社 | 障害物検出装置、走行装置、障害物検出システムおよび障害物検出方法 |
CN107009968B (zh) * | 2017-03-28 | 2020-08-28 | 驭势科技(北京)有限公司 | 车载激光雷达控制方法、装置及车载设备 |
CN108956761B (zh) * | 2017-05-23 | 2020-12-25 | 浙江工商职业技术学院 | 钢板全覆盖超声波检测装置及方法 |
CN108037515A (zh) * | 2017-12-27 | 2018-05-15 | 清华大学苏州汽车研究院(吴江) | 一种激光雷达和超声波雷达信息融合***及方法 |
CN108333589A (zh) * | 2018-03-13 | 2018-07-27 | 苏州青飞智能科技有限公司 | 一种自动驾驶车辆障碍物检测装置 |
CN112394359A (zh) * | 2019-08-15 | 2021-02-23 | 北醒(北京)光子科技有限公司 | 一种激光雷达及其一维扫描方法 |
CN110988885B (zh) * | 2019-12-24 | 2021-12-03 | 深圳南方德尔汽车电子有限公司 | 汽车周围环境监测方法与装置和***及存储介质 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2384816Y (zh) * | 1999-07-07 | 2000-06-28 | 华强 | 一种单片机控制的组合汽车防撞装置 |
CN201484347U (zh) * | 2009-07-03 | 2010-05-26 | 北京工业大学 | 汽车防追尾及倒车预警器 |
CN201917661U (zh) * | 2010-11-29 | 2011-08-03 | 浙江亚特电器有限公司 | 一种移动机器人定位*** |
DE202013011576U1 (de) * | 2013-12-23 | 2014-03-17 | Günter Holland-Letz | Garagen Park-Assistenzsystem |
-
2014
- 2014-03-06 CN CN201410080250.0A patent/CN103913748B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN103913748A (zh) | 2014-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103913748B (zh) | 一种基于多传感器的汽车感知***及感知方法 | |
KR102107774B1 (ko) | 목표차량의 운전패턴에 따른 협조 적응 순항 제어 시스템 | |
RU2668786C1 (ru) | Устройство помощи при парковке и способ помощи при парковке | |
US9905024B2 (en) | Object recognition device, vehicle having the same and method of controlling the same | |
US10452930B2 (en) | Information display device mounted in vehicle including detector | |
CN105398389B (zh) | 一种汽车安全驾驶辅助检测***及方法 | |
CN108928343A (zh) | 一种全景融合自动泊车***及方法 | |
JP6555067B2 (ja) | 車線変更支援装置 | |
Taraba et al. | Utilization of modern sensors in autonomous vehicles | |
CN110867132B (zh) | 环境感知的方法、装置、电子设备和计算机可读存储介质 | |
WO2016063529A1 (ja) | 物体検知装置 | |
CN106663379A (zh) | 用于具有拖车的车辆的增强的盲点检测 | |
CN111812657B (zh) | 一种基于车辆的泊车空间确定方法和装置 | |
WO2016063532A1 (ja) | 車載用物体判別装置 | |
US20140156178A1 (en) | Road marker recognition device and method | |
JPWO2011145141A1 (ja) | 車両後方監視装置 | |
JP2016505451A (ja) | 自動車システム及び方法 | |
KR101819967B1 (ko) | 차량의 물체 감지방법 | |
US20170166218A1 (en) | Apparatus and method for use in a vehicle | |
US11292481B2 (en) | Method and apparatus for multi vehicle sensor suite diagnosis | |
US20170174224A1 (en) | Apparatus and method for use in a vehicle | |
CN106740838A (zh) | 一种车辆危险预警*** | |
US11713039B2 (en) | Driving support system and method | |
CN110492811A (zh) | 驻坡能力提升方法和装置 | |
US11092688B1 (en) | Spatial and temporal processing of ultrasonic sensor detections for mapping in vehicle-parking-assist functions |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |