CN104290658B - 一种用于前路危险状况检测的报警装置及方法 - Google Patents
一种用于前路危险状况检测的报警装置及方法 Download PDFInfo
- Publication number
- CN104290658B CN104290658B CN201410512866.0A CN201410512866A CN104290658B CN 104290658 B CN104290658 B CN 104290658B CN 201410512866 A CN201410512866 A CN 201410512866A CN 104290658 B CN104290658 B CN 104290658B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- current moment
- relative
- moment
- dangerous situation
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000001514 detection method Methods 0.000 title claims description 6
- 230000006399 behavior Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000005070 sampling Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Landscapes
- Traffic Control Systems (AREA)
Abstract
本发明属于汽车主动安全技术领域,特别涉及一种用于前路危险状况检测的报警装置及方法。该用于前路危险状况检测的报警装置包括:车辆、位于车辆内的数据处理单元、固定于车辆前方保险杠正中央的激光扫描雷达、以及固定在车辆仪表盘上的闪光蜂鸣器,所述激光扫描雷达的激光发射端朝向车辆前方;所述激光扫描雷达的信号输出端电连接所述数据处理单元的信号输入端,所述数据处理单元的信号输出端电连接所述闪光蜂鸣器。
Description
技术领域
本发明属于汽车主动安全技术领域,特别涉及一种用于前路危险状况检测的报警装置及方法。
背景技术
当汽车在道路上正常行驶时,经常会遇到前车换道或减速行驶的情况,这种情况非常常见,因为前车会根据自己的需求换道超车或选择合适自己的车道和速度。如果前方有一辆车或两辆车同时换道或减速,可以认定为正常情况,但是如果前方多辆车同时换道或减速,则可能是前方发生危险,例如前方发生碰撞事故,后方车辆选择换道或减速来避让危险。这种情况下如果本车驾驶员没有发现危险或发现较晚就有可能发生安全事故,有两种情况可能发生:一是驾驶员没有发现危险继续行车,则可能撞上前方的车辆,后果非常严重;二是发现较晚,发现危险后紧急避让,这样存在安全隐患。
发明内容
本发明的目的在于提出一种用于前路危险状况检测的报警装置及方法,本发明可以检测前方车辆所造成的危险状况并及时通知驾驶员,确保驾驶员有足够时间避让危险。
为实现上述技术目的,本发明采用如下技术方案予以实现。
技术方案一:
一种用于前路危险状况检测的报警装置包括:车辆、位于车辆内的数据处理单元、固定于车辆前方保险杠正中央的激光扫描雷达、以及固定在车辆仪表盘上的闪光蜂鸣器,所述激光扫描雷达的激光发射端朝向车辆前方;
所述激光扫描雷达的信号输出端电连接所述数据处理单元的信号输入端,所述数据处理单元的信号输出端电连接所述闪光蜂鸣器。
所述数据处理单元为ARM处理器、单片机或工控机。
所述激光扫描雷达为SICK安全激光扫描仪,其具体型号为S3000;所述闪光蜂鸣器为AD16-22SM型闪光蜂鸣器。
本技术方案的特点和进一步改进在于:
所述激光扫描雷达用于采集前方车辆的点云数据,并用于将采集的前方车辆的点云数据实时发送至数据处理单元;所述数据处理单元用于根据前方车辆的点云数据,判断自身车辆前方是否出现危险状况;所述数据处理单元用于在自身车辆前方出现危险状况时,控制闪光蜂鸣器发光发声。
技术方案二:
一种用于前路危险状况检测的报警方法,基于上述一种用于前路危险状况检测的报警装置,包括以下步骤:
S1:车辆开始行驶后,激光扫描雷达实时采集每个前方车辆的点云数据,并将采集到的每个前方车辆的点云数据实时发送至数据处理单元;
S2:在数据处理单元中,得出当前时刻每个前方车辆相对自身车辆的横向相对速度;得出当前时刻每个前方车辆相对自身车辆的横向相对速度的过程为:根据当前时刻对应的前方车辆的点云数据,得出当前时刻对应的前方车辆与自身车辆的横向相对距离;如果当前时刻对应的前方车辆位于自身车辆的前方左侧,则当前时刻对应的前方车辆与自身车辆的横向相对距离为正数,反之,如果当前时刻对应的前方车辆位于自身车辆的前方右侧,则当前时刻对应的前方车辆与自身车辆的横向相对距离为负数;然后,得出当前时刻对应的前方车辆相对自身车辆的横向相对速度Vx;Vx=(dx1-dx2)/t,dx1表示当前时刻对应的前方车辆与自身车辆的横向相对距离,dx2表示上一时刻对应的前方车辆与自身车辆的横向相对距离,t表示当前时刻与上一时刻的时间差;
如果截止到当前时刻连续b次得出的对应的前方车辆相对自身车辆的横向相对速度均大于0,则认为当前时刻对应的前方车辆正在进行换道;如果当前时刻连续b次得出的对应的前方车辆相对自身车辆的横向相对速度均小于0,则认为当前时刻对应的前方车辆正在进行换道;然后,统计当前时刻进行换道的前方车辆的个数;
S3:根据当前时刻进行换道的前方车辆的个数,判断自身车辆前方是否出现危险状况;数据处理单元在自身车辆前方出现危险状况时,控制闪光蜂鸣器发光发声。
本技术方案的特点和进一步改进在于:
在步骤S3中,如果当前时刻进行换道的前方车辆的个数大于设定的换道车辆个数阈值,则认为自身车辆前方出现危险状况。
在步骤S2中,数据处理单元中在得出当前时刻每个前方车辆相对自身车辆的横向相对速度的同时,得出当前时刻每个前方车辆相对自身车辆的纵向相对速度;得出当前时刻每个前方车辆相对自身车辆的纵向相对速度的过程为:根据当前时刻对应的前方车辆的点云数据,得出当前时刻对应的前方车辆与自身车辆的纵向相对距离;然后,得出当前时刻对应的前方车辆相对自身车辆的纵向相对速度Vy;Vy=(dy1-dy2)/t,dy1表示当前时刻对应的前方车辆与自身车辆的纵向相对距离,dy2表示上一时刻对应的前方车辆与自身车辆的纵向相对距离,t表示当前时刻与上一时刻的时间差;
然后,得出当前时刻每个前方车辆相对自身车辆的减速度;当前时刻对应的前方车辆相对自身车辆的减速度a为:a=(Vy1-Vy2)/t,其中,Vy1表示当前时刻对应的前方车辆相对自身车辆的纵向相对速度,Vy2表示当前时刻对应的前方车辆相对自身车辆的纵向相对速度;如果a小于设定的减速度阈值,则认为对应的前方车辆出现危险减速行为;
在步骤S3中,根据当前时刻进行换道的前方车辆的个数和当前时刻出现危险减速行为的前方车辆的个数,判断自身车辆前方是否出现危险状况。
在步骤S3中,如果当前时刻进行换道的前方车辆的个数和当前时刻出现危险减速行为的前方车辆的个数之和大于设定的危险状况阈值,则认为自身车辆前方出现危险状况。
本发明的有益效果为:能够在自身车辆前方出现危险路况时,及时地向驾驶员发出声光警报。
附图说明
图1为本发明的一种用于前路危险状况检测的报警装置的电路结构示意图;
图2为本发明的一种用于前路危险状况检测的报警装置的工作过程示意图。
具体实施方式
下面结合附图对本发明作进一步说明:
参照图1,为本发明的一种用于前路危险状况检测的报警装置的电路结构示意图。该用于前路危险状况检测的报警装置包括车辆,在车辆内设置有数据处理单元,数据处理单元用于识别自身车辆前方的危险状况。数据处理单元为ARM处理器、单片机或工控机。
本发明实施例中,在车辆前方保险杠正中央固定有激光扫描雷达,用于采集前方车辆的点云数据。该激光扫描雷达为SICK安全激光扫描仪,其具体型号为S3000,扫描角度为190度,保护区域范围为7m,120毫秒分辨率为30-150mm。该激光扫描雷达的信号输出端电连接上述数据处理单元的信号输入端,激光扫描雷达用于将采集的前方车辆的点云数据实时发送至数据处理单元。
本发明实施例中,在车辆仪表盘上或驾驶室方向盘旁边固定有闪光蜂鸣器,该闪光蜂鸣器为上海二工AD16-22SM型闪光蜂鸣器。该闪光蜂鸣器电连接数据处理单元的信号输出端;当数据处理单元接收到前方车辆的点云数据时,根据前方车辆的点云数据,判断自身车辆前方是否出现危险状况;在自身车辆前方出现危险状况时,控制闪光蜂鸣器发光发声,以提醒驾驶员注意前方路况。
参照图2,为本发明的一种用于前路危险状况检测的报警装置的工作过程示意图。对该用于前路危险状况检测的报警装置的工作过程说明如下:
车辆开始行驶后,激光扫描雷达实时采集每个前方车辆的点云数据,并将采集到的每个前方车辆的点云数据实时发送至数据处理单元。
在数据处理单元中,得出当前时刻每个前方车辆相对自身车辆的横向相对速度。前方车辆相对自身车辆的横向相对速度可以作为前方车辆是否进行换道的标准。本发明实施例中,得出当前时刻每个前方车辆相对自身车辆的横向相对速度的过程为:根据当前时刻对应的前方车辆的点云数据,得出当前时刻对应的前方车辆与自身车辆的横向相对距离。如果当前时刻对应的前方车辆位于自身车辆的前方左侧,则当前时刻对应的前方车辆与自身车辆的横向相对距离为正数,反之,如果当前时刻对应的前方车辆位于自身车辆的前方右侧,则当前时刻对应的前方车辆与自身车辆的横向相对距离为负数;具体地说,前方车辆的点云数据为在以激光扫描雷达为原点的三维直角坐标系中的点云数据,该三维直角坐标系的X轴正向表示车道的横向向左方向,该三维直角坐标系的X轴负向表示车道的横向向右方向,该三维直角坐标系的Y轴正向表示车辆沿车道的行驶方向,该三维直角坐标系的Z轴正向表示竖直向上方向。
然后,得出当前时刻对应的前方车辆相对自身车辆的横向相对速度Vx;Vx=(dx1-dx2)/t,dx1表示当前时刻对应的前方车辆与自身车辆的横向相对距离,dx2表示上一时刻对应的前方车辆与自身车辆的横向相对距离,t表示当前时刻与上一时刻的时间差。当前时刻与激光扫描雷达当前的一次采样相对应,上一时刻与激光扫描雷达的上一次采样相对应。
如果截止到当前时刻连续b次得出的对应的前方车辆相对自身车辆的横向相对速度均大于0(说明对应的前方车辆相对自身车辆进行持续横向向左的运动),则认为当前时刻对应的前方车辆正在进行换道;如果当前时刻连续b次得出的对应的前方车辆相对自身车辆的横向相对速度均小于0(说明对应的前方车辆相对自身车辆进行持续横向向右的运动),则认为当前时刻对应的前方车辆正在进行换道;然后,统计当前时刻进行换道的前方车辆的个数;本发明实施例中,b的取值为5至10。
根据当前时刻进行换道的前方车辆的个数,判断自身车辆前方是否出现危险状况;数据处理单元在自身车辆前方出现危险状况时,控制闪光蜂鸣器发光发声。具体地说,如果当前时刻进行换道的前方车辆的个数大于设定的换道车辆个数阈值,则认为自身车辆前方出现危险状况。本发明实施例中,设定的换道车辆个数阈值为2或3。当当前时刻进行换道的前方车辆的个数大于设定的换道车辆个数阈值时,激光扫描雷达持续工作,当某一时刻进行换道的前方车辆的个数不大于设定的换道车辆个数阈值,数据处理单元不向闪光蜂鸣器发出控制信号,闪光蜂鸣器停止发光发声。
作为本发明实施例的一种改进,数据处理单元中在得出当前时刻每个前方车辆相对自身车辆的横向相对速度的同时,得出当前时刻每个前方车辆相对自身车辆的纵向相对速度;得出当前时刻每个前方车辆相对自身车辆的纵向相对速度的过程为:根据当前时刻对应的前方车辆的点云数据,得出当前时刻对应的前方车辆与自身车辆的纵向相对距离;当前时刻对应的前方车辆与自身车辆的纵向相对距离为正数。然后,得出当前时刻对应的前方车辆相对自身车辆的纵向相对速度Vy;Vy=(dy1-dy2)/t,dy1表示当前时刻对应的前方车辆与自身车辆的纵向相对距离,dy2表示上一时刻对应的前方车辆与自身车辆的纵向相对距离,t表示当前时刻与上一时刻的时间差;如果Vy大于0,说明当前时刻对应的前方车辆相对自身车辆向车道的前进方向行驶,两车距离正在加大。反之如果Vy小于0,说明当前时刻自身车辆相对对应的前方车辆向车道的前进方向行驶,两车距离正在缩短。
然后,得出当前时刻每个前方车辆相对自身车辆的减速度;当前时刻对应的前方车辆相对自身车辆的减速度a为:a=(Vy1-Vy2)/t,其中,Vy1表示当前时刻对应的前方车辆相对自身车辆的纵向相对速度,Vy2表示当前时刻对应的前方车辆相对自身车辆的纵向相对速度;如果a小于设定的减速度阈值(负数),则认为对应的前方车辆出现危险减速行为,可能导致追尾事故的发生。否则,不认为对应的前方车辆出现危险减速行为。本发明实施例中,设定的减速度阈值为-1m/s2。
然后,根据当前时刻进行换道的前方车辆的个数和当前时刻出现危险减速行为的前方车辆的个数,判断自身车辆前方是否出现危险状况。具体地,如果当前时刻进行换道的前方车辆的个数m和当前时刻出现危险减速行为的前方车辆的个数之和n大于设定的危险状况阈值,则认为自身车辆前方出现危险状况,否则,不认为自身车辆前方出现危险状况。本发明实施例中,设定的危险状况阈值为2或3。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (4)
1.一种用于前路危险状况检测的报警方法,应用于前路危险状况检测的报警装置,所述报警装置包括:车辆、位于车辆内的数据处理单元、固定于车辆前方保险杠正中央的激光扫描雷达、以及固定在车辆仪表盘上的闪光蜂鸣器,所述激光扫描雷达的激光发射端朝向车辆前方;所述激光扫描雷达的信号输出端电连接所述数据处理单元的信号输入端,所述数据处理单元的信号输出端电连接所述闪光蜂鸣器;
其特征在于,所述报警方法包括以下步骤:
S1:车辆开始行驶后,激光扫描雷达实时采集每个前方车辆的点云数据,并将采集到的每个前方车辆的点云数据实时发送至数据处理单元;
S2:在数据处理单元中,得出当前时刻每个前方车辆相对自身车辆的横向相对速度;得出当前时刻每个前方车辆相对自身车辆的横向相对速度的过程为:根据当前时刻对应的前方车辆的点云数据,得出当前时刻对应的前方车辆与自身车辆的横向相对距离;如果当前时刻对应的前方车辆位于自身车辆的前方左侧,则当前时刻对应的前方车辆与自身车辆的横向相对距离为正数,反之,如果当前时刻对应的前方车辆位于自身车辆的前方右侧,则当前时刻对应的前方车辆与自身车辆的横向相对距离为负数;然后,得出当前时刻对应的前方车辆相对自身车辆的横向相对速度Vx;Vx=(dx1-dx2)/t,dx1表示当前时刻对应的前方车辆与自身车辆的横向相对距离,dx2表示上一时刻对应的前方车辆与自身车辆的横向相对距离,t表示当前时刻与上一时刻的时间差;
如果截止到当前时刻连续b次得出的对应的前方车辆相对自身车辆的横向相对速度均大于0,则认为当前时刻对应的前方车辆正在进行换道;如果当前时刻连续b次得出的对应的前方车辆相对自身车辆的横向相对速度均小于0,则认为当前时刻对应的前方车辆正在进行换道;然后,统计当前时刻进行换道的前方车辆的个数;
S3:根据当前时刻进行换道的前方车辆的个数,判断自身车辆前方是否出现危险状况;数据处理单元在自身车辆前方出现危险状况时,控制闪光蜂鸣器发光发声。
2.如权利要求1所述的一种用于前路危险状况检测的报警方法,其特征在于,在步骤S3中,如果当前时刻进行换道的前方车辆的个数大于设定的换道车辆个数阈值,则认为自身车辆前方出现危险状况。
3.如权利要求1所述的一种用于前路危险状况检测的报警方法,其特征在于,在步骤S2中,数据处理单元中在得出当前时刻每个前方车辆相对自身车辆的横向相对速度的同时,得出当前时刻每个前方车辆相对自身车辆的纵向相对速度;得出当前时刻每个前方车辆相对自身车辆的纵向相对速度的过程为:根据当前时刻对应的前方车辆的点云数据,得出当前时刻对应的前方车辆与自身车辆的纵向相对距离;然后,得出当前时刻对应的前方车辆相对自身车辆的纵向相对速度Vy;Vy=(dy1-dy2)/t,dy1表示当前时刻对应的前方车辆与自身车辆的纵向相对距离,dy2表示上一时刻对应的前方车辆与自身车辆的纵向相对距离,t表示当前时刻与上一时刻的时间差;
然后,得出当前时刻每个前方车辆相对自身车辆的减速度;当前时刻对应的前方车辆相对自身车辆的减速度a为:a=(Vy1-Vy2)/t,其中,Vy1表示当前时刻对应的前方车辆相对自身车辆的纵向相对速度,Vy2表示当前时刻对应的前方车辆相对自身车辆的纵向相对速度;如果a小于设定的减速度阈值,则认为对应的前方车辆出现危险减速行为;
在步骤S3中,根据当前时刻进行换道的前方车辆的个数和当前时刻出现危险减速行为的前方车辆的个数,判断自身车辆前方是否出现危险状况。
4.如权利要求3所述的一种用于前路危险状况检测的报警方法,其特征在于,在步骤S3中,如果当前时刻进行换道的前方车辆的个数和当前时刻出现危险减速行为的前方车辆的个数之和大于设定的危险状况阈值,则认为自身车辆前方出现危险状况。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410512866.0A CN104290658B (zh) | 2014-09-29 | 2014-09-29 | 一种用于前路危险状况检测的报警装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410512866.0A CN104290658B (zh) | 2014-09-29 | 2014-09-29 | 一种用于前路危险状况检测的报警装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104290658A CN104290658A (zh) | 2015-01-21 |
CN104290658B true CN104290658B (zh) | 2018-03-06 |
Family
ID=52310691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410512866.0A Expired - Fee Related CN104290658B (zh) | 2014-09-29 | 2014-09-29 | 一种用于前路危险状况检测的报警装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104290658B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106598053B (zh) * | 2016-12-19 | 2018-01-02 | 驭势科技(北京)有限公司 | 一种自动驾驶车辆横向运动控制对象选择方法 |
KR102540919B1 (ko) * | 2018-02-20 | 2023-06-07 | 현대자동차주식회사 | 차량의 주행 제어 장치 및 방법 |
CN109360410B (zh) * | 2018-10-11 | 2021-03-30 | 百度在线网络技术(北京)有限公司 | 车辆协调方法、装置、车辆和介质 |
CN109830105A (zh) * | 2019-03-18 | 2019-05-31 | 中国安全生产科学研究院 | 一种防止车辆碰撞路侧固定危险物的装置及方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB9303434D0 (en) * | 1993-02-20 | 1993-04-07 | Lucas Ind Plc | Method of and apparatus for cruise control |
JP3104559B2 (ja) * | 1995-02-08 | 2000-10-30 | トヨタ自動車株式会社 | 車載用レーダ装置 |
US7546182B2 (en) * | 2006-02-21 | 2009-06-09 | Gm Global Technology Operations, Inc. | Inter vehicular ad hoc routing protocol and communication system |
US8314718B2 (en) * | 2009-10-02 | 2012-11-20 | GM Global Technology Operations LLC | Reducing the computational load on processors by selectively discarding data in vehicular networks |
US8694222B2 (en) * | 2011-10-26 | 2014-04-08 | GM Global Technology Operations LLC | Collision avoidance system and method of operating the same |
CN202345598U (zh) * | 2011-11-11 | 2012-07-25 | 长安大学 | 一种车辆换道危险预警装置 |
CN204124041U (zh) * | 2014-09-29 | 2015-01-28 | 长安大学 | 一种用于前路危险状况检测的报警装置 |
-
2014
- 2014-09-29 CN CN201410512866.0A patent/CN104290658B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN104290658A (zh) | 2015-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104916165B (zh) | 一种前车驾驶员不安全驾驶行为检测方法及装置 | |
CN107111952B (zh) | 响应于极快接近的车辆的车道辅助系统 | |
CN103587467B (zh) | 一种危险超车预警提示方法 | |
JP6629040B2 (ja) | 交通情報提供装置及びシステム及び方法 | |
CN106448190B (zh) | 高速公路自车周围车流量实时监测预警装置及方法 | |
WO2017042089A1 (en) | Automated detection of hazardous drifting vehicles by vehicle sensors | |
US20240379003A1 (en) | Information notification device and information notification method | |
CN106809160B (zh) | 一种交叉路口驾驶辅助方法及系统 | |
CN104751677B (zh) | 车辆碰撞报警方法和系统 | |
CN103587524A (zh) | 一种横向主动避撞系统及其控制方法 | |
JP2015022758A (ja) | インテリジェント型前方衝突警報システム | |
JP2016514643A (ja) | 追越アシスタント用の方法、並びに、装置 | |
CN102963300A (zh) | 防止车辆转弯时与非机动车发生碰撞的提示装置及其方法 | |
CN104700658A (zh) | 用于避免机动车与错误行驶的车辆的碰撞的方法以及控制与检测装置 | |
CN106428002B (zh) | 一种基于车辆主动安全的防撞预警装置及方法 | |
CN108520639B (zh) | 一种防止车辆碰撞的预警方法及系统 | |
CN104290658B (zh) | 一种用于前路危险状况检测的报警装置及方法 | |
CN109969191B (zh) | 驾驶辅助系统和方法 | |
CN106004671A (zh) | 一种交叉路口车辆防碰撞系统及防碰撞方法 | |
CN108885839A (zh) | 监视装置和监视方法 | |
CN203047064U (zh) | 一种防止车辆转弯时与非机动车发生碰撞的提示装置 | |
CN108706005A (zh) | 一种基于激光测距的车载防撞装置 | |
US11763681B2 (en) | ECU and lane departure warning system | |
JP7380449B2 (ja) | 判定装置及びプログラム | |
CN117842004B (zh) | 控制车辆行驶的方法、装置、电子设备及可读存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180306 |