CN107139922B - 一种汽车防追尾方法 - Google Patents
一种汽车防追尾方法 Download PDFInfo
- Publication number
- CN107139922B CN107139922B CN201710198347.5A CN201710198347A CN107139922B CN 107139922 B CN107139922 B CN 107139922B CN 201710198347 A CN201710198347 A CN 201710198347A CN 107139922 B CN107139922 B CN 107139922B
- Authority
- CN
- China
- Prior art keywords
- distance
- image
- automobile
- camera
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 11
- 230000002265 prevention Effects 0.000 title claims description 7
- 230000001133 acceleration Effects 0.000 claims abstract description 10
- 230000009466 transformation Effects 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 5
- 239000004576 sand Substances 0.000 claims description 2
- 230000002194 synthesizing effect Effects 0.000 claims description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000011426 transformation method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0953—Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q9/00—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling
- B60Q9/008—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling for anti-collision purposes
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
- Image Processing (AREA)
Abstract
本发明涉及一种汽车防追尾方法,步骤包括:1)标定摄像头;2)识别连续两帧图像中汽车获取每帧图像中前后两车之间的距离以及获取连续两帧图像之间的时间间隔,从而求取前后两车当前的相对速度;3)从惯性导航系统中获取汽车当前加速度和当前行驶速度,并通过当前行驶速度求取两车该保持的安全距离;4)若第二帧图像车距小于安全距离,则进入步骤5),否则进入下一帧图像处理;5)综合前后两车的相对速度、汽车当前加速度、当前速度下应保持的安全距离和第二帧图像车距即当前两车测得的距离判断是否存在追尾事故发生的隐患,并及时持续地发出警告;6)重复步骤2)‑5)直到汽车停止。本发明具有可靠性和准确性高、告警发出速度快等优点。
Description
技术领域
本发明涉及计算机视觉和惯性导航领域,尤其涉及到一种汽车防追尾方法。
背景技术
随着人们生活条件的不断提高,汽车逐步走进千家万户,给人们出行带来极大的方便。但随着汽车普有量不断增多,给交通带来的压力也随之而增大,驾驶员为了争取时间常会加大油门驾驶,以致汽车追尾的情况时有发生。
为了判断是否存在追尾隐患,现有的技术利用安装在汽车上的摄像头提供的图像信息进行检测,从而给出告警信息。
例如,在专利文献(CN106080381A一种基于图像识别检测的汽车防追尾的预警系统)中,记载有通过使用图像处理技术检测是否存在汽车追尾隐患从而发出告警信息的方法。在该文献中,通过图像拍摄模块获取汽车尾部图像信息,图像识别模块识别图像中的信息;然后通过控制模块提取汽车CAN总线数据综合前两个模块的信息处理结果判断是否存在追尾隐患,最后通过预警模块发出预警信息。
但是,该专利文献采用的基于图像识别技术实现的汽车防追尾的预警系统过于简单,未能充分利用图像提供的大量信息,例如,并没有通过相关技术获得图像中检测到的汽车在现实物理空间中的距离信息。
发明内容
本发明的目的在于克服现有技术的不足,提供一种可靠性和准确性高、告警发出速度快的汽车防追尾方法。
为实现上述目的,本发明所提供的技术方案为:包括以下步骤:
(1)标定摄像头;
(2)对相机中的图像作图像识别,识别图像中汽车;
(3)通过系统函数time()调取获取该帧图像时的时间,求取图像中前后两车之间的距离;
(4)重复步骤(2)-(3),通过计算获得连续两帧图像之间的时间间隔t=difftime(tq+1,tq)以及连续两帧图像中每帧图像前后两车之间的距离dq、dq+1,求取前后两车当前的相对速度vt;
(5)从汽车的惯性导航系统中获取汽车当前加速度a和当前行驶速度vc,并通过当前行驶速度求取两车该保持的安全距离ds;
(6)若第二帧图像车距dq+1小于安全距离ds,则进入步骤(6),否则进入下一帧图像处理;
(7)综合前后两车的相对速度vt、汽车当前加速度a、当前速度下应保持的安全距离ds和第二帧图像车距dq+1即当前两车测得的距离dq+1判断是否存在追尾事故发生的安全隐患,并及时持续地发出警告;
(8)重复步骤(2)-(7)直到汽车停止。
进一步地,所述标定摄像头包括以下步骤:
(1用安装在汽车中的摄像头拍摄多张含有多个角点的棋盘图;
(2使用OpenCV中的API对摄像头进行标定获得摄像头的内参;
(4测量摄像头到汽车前沿的距离l。
进一步地,所述内参包括fx、fy、cx和cy,其中,fx为每个像素在相机坐标系中横向的物理长度;fy为每个像素在相机坐标系中纵向的物理长度;cx和cy为主点坐标。
其中,c1=cos(α),c2=cos(β),s1=sin(α),s2=sin(β)。
进一步地,所述步骤(3)图像中前后两车之间的距离通过以下步骤求取:找出图像中汽车两个后轮与地面接触处的两个中点A和B,求出该A和B之间的中点C(u,v),并对中点C(u,v)做逆透视变换还原为世界坐标系的坐标G(x,y,h,1),从而求得两车的距离y-l。
进一步地,所述判断是否存在追尾隐患的步骤如下:
1)若a>0和vt<0;则发出存在严重追尾隐患警告;
2)若a>0和vt≥0;则发出存在追尾隐患;
3)若a≤0和vt<0;则发出存在追尾隐患;
4)若a≤0和vt≥0;则两车距离逐渐拉开,不发出追尾警告。
与现有技术相比,本方案的原理以及相应的有益效果如下:
1.对图像的处理除了识别图像中的汽车外,利用逆透视变换的方法求取两车的距离,充分地利用图像中的信息,大大提高测距的准确性。
2.依据前面的汽车在真实地物理空间中的位置信息、两车的相对加速度、以及当前行驶速度下该保持的安全距离综合判断是否存在追尾隐患,使发出的告警信息具有较高可靠性。
3.每帧图像求取两车距离时只用到一个点做逆透视变换,运算量小,运算速度快,使告警信息更快提示出来,让驾驶员有充足的时间作反应。
附图说明
图1为本发明的软件算法流程图。
具体实施方式
下面结合具体实施例对本发明作进一步说明:
参见附图1所示,本实施例所述的一种汽车防追尾方法,包括以下步骤:
(1)标定摄像头;
(1用安装在汽车中的摄像头拍摄多张含有多个角点的棋盘图;
(2使用OpenCV(一个基于BSD许可(开源)发行的跨平台计算机视觉库)中的API对摄像头进行标定获得摄像头的内参fx、fy、cx和cy,其中,fx为每个像素在相机坐标系中横向的物理长度;fy为每个像素在相机坐标系中纵向的物理长度;cx和cy为主点坐标;
其中,c1=cos(α),c2=cos(β),s1=sin(α),s2=sin(β);
(4测量摄像头到汽车前沿的距离l;
(2)对相机中的图像作图像识别,识别图像中汽车,通过系统函数time()调取获取该帧图像时的时间tq;
(3)从图像的汽车中提取两个点的坐标,分别为汽车尾部左右两个车轮与地面接触的中点A和B;
(4)求取A和B的中点C(u,v);
(5)使用计算机视觉的逆透视变换计算C(u,v)在世界坐标系的坐标G(x,y,h,1);
(6)计算两车的距离dq=y-l;
(7)重复步骤(2)-(6)对下一帧图像做重复操作获得该帧图像测得的两车距离dq+1以及获取该帧图像时的时间tq+1;
(8)通过计算获得连续两帧图像之间的时间间隔t=difftime(tq+1,tq)以及连续两帧图像中每帧图像前后两车之间的距离dq、dq+1,计算此时两车的相对速度vt=(dq+1-dq)/t;
(9)从加速度计中获取当前加速度a;
(10)获取当前汽车的当前速度vc;
(11)求取当前速度下前后两车应该保持的安全距离ds;
(12)若dq+1<ds,则进行步骤(13),否则进入步骤(14);
(13)综合加速度a、安全距离ds、两车相对速度vt和当前测得的两侧距离dq+1做如下判断是否存在追尾隐患:
1)若a>0和vt<0;则发出存在严重追尾隐患警告;
2)若a>0和vt≥0;则发出存在追尾隐患;
3)若a≤0和vt<0;则发出存在追尾隐患;
4)若a≤0和vt≥0;则两车距离逐渐拉开,不发出追尾警告;
(14)进入下一帧图像处理;
(15)重复步骤(2)-(14)直到汽车停止。
本实施例对图像的处理除了识别图像中的汽车外,利用逆透视变换的方法求取两车的距离,充分地利用图像中的信息,大大提高测距的准确性。
另外,本实施例依据前面的汽车在真实地物理空间中的位置信息、两车的相对加速度、以及当前行驶速度下该保持的安全距离综合判断是否存在追尾隐患,使发出的告警信息具有较高可靠性。
最后,本实施例中每帧图像求取两车距离时只用到一个点做逆透视变换,运算量小,运算速度快,使告警信息更快提示出来,让驾驶员有充足的时间作反应。
以上所述之实施例子只为本发明之较佳实施例,并非以此限制本发明的实施范围,故凡依本发明之形状、原理所作的变化,均应涵盖在本发明的保护范围内。
Claims (2)
1.一种汽车防追尾方法,其特征在于:包括以下步骤:
(1)标定摄像头;
(2)对相机中的图像作图像识别,识别图像中汽车;
(3)调取获取该帧图像时的时间,求取图像中前后两车之间的距离;
(4)重复步骤(2)-(3),通过计算获得连续两帧图像之间的时间间隔t以及连续两帧图像中每帧图像前后两车之间的距离dq、dq+1,求取前后两车当前的相对速度vt;
(5)从汽车的惯性导航系统中获取汽车当前加速度a和当前行驶速度vc,并通过当前行驶速度求取两车该保持的安全距离ds;
(6)若第二帧图像车距dq+1小于安全距离ds,则进入步骤(7),否则进入下一帧图像处理;
(7)综合前后两车的相对速度vt、汽车当前加速度a、当前速度下应保持的安全距离ds和第二帧图像车距dq+1即当前两车测得的距离dq+1判断是否存在追尾事故发生的安全隐患,并及时持续地发出警告;
(8)重复步骤(2)-(7)直到汽车停止;
所述步骤(3)图像中前后两车之间的距离通过以下步骤求取:找出图像中汽车两个后轮与地面接触处的两个中点A和B,求出该A和B之间的中点C(u,v),并对中点C(u,v)做逆透视变换还原为世界坐标系的坐标G(x,y,h,1),从而求得两车的距离y-l;
所述标定摄像头包括以下步骤:
(1用安装在汽车中的摄像头拍摄多张含有多个角点的棋盘图;
(2使用OpenCV中的API对摄像头进行标定获得摄像头的内参;
(4测量摄像头到汽车前沿的距离l;
其中,c1=cos(α),c2=cos(β),s1=sin(α),s2=sin(β);
所述内参包括fx、fy、cx和cy,其中,fx为每个像素在相机坐标系中横向的物理长度;fy为每个像素在相机坐标系中纵向的物理长度;cx和cy为主点坐标。
2.根据权利要求1所述的一种汽车防追尾方法,其特征在于:所述判断是否存在追尾隐患的步骤如下:
1)若a>0和vt<0;则发出存在严重追尾隐患警告;
2)若a>0和vt≥0;则发出存在追尾隐患;
3)若a≤0和vt<0;则发出存在追尾隐患;
4)若a≤0和vt≥0;则两车距离逐渐拉开,不发出追尾警告。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710198347.5A CN107139922B (zh) | 2017-03-29 | 2017-03-29 | 一种汽车防追尾方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710198347.5A CN107139922B (zh) | 2017-03-29 | 2017-03-29 | 一种汽车防追尾方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107139922A CN107139922A (zh) | 2017-09-08 |
CN107139922B true CN107139922B (zh) | 2021-02-09 |
Family
ID=59783670
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710198347.5A Expired - Fee Related CN107139922B (zh) | 2017-03-29 | 2017-03-29 | 一种汽车防追尾方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107139922B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7135746B2 (ja) * | 2018-11-07 | 2022-09-13 | トヨタ自動車株式会社 | 運転支援装置 |
CN109472251B (zh) * | 2018-12-16 | 2022-04-05 | 华为技术有限公司 | 一种物体碰撞预测方法及装置 |
CN109747644A (zh) * | 2019-03-01 | 2019-05-14 | 广州杰赛科技股份有限公司 | 车辆跟踪防撞预警方法、装置、控制器、系统及车辆 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101391589A (zh) * | 2008-10-30 | 2009-03-25 | 上海大学 | 车载智能报警方法和装置 |
CN101559753A (zh) * | 2009-05-27 | 2009-10-21 | 北京工业大学 | 基于单目机器视觉的汽车主动安全系统及其控制方法 |
CN102685516A (zh) * | 2011-03-07 | 2012-09-19 | 李慧盈 | 立体视觉主动安全辅助驾驶方法 |
CN102874196A (zh) * | 2011-07-11 | 2013-01-16 | 北京新岸线移动多媒体技术有限公司 | 一种机器视觉的汽车防撞方法及系统 |
DE102013200385A1 (de) * | 2013-01-14 | 2014-07-17 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Unterstützung eines Fahrers eines Fahrzeugs bei einer Fahrt auf unebenem Gelände |
-
2017
- 2017-03-29 CN CN201710198347.5A patent/CN107139922B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN107139922A (zh) | 2017-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10255813B2 (en) | Moving object collision warning system and method for large vehicle | |
JP5389864B2 (ja) | 車線逸脱警報装置 | |
US6690011B2 (en) | Infrared image-processing apparatus | |
CN110696823B (zh) | 一种预估车辆发生碰撞时间的方法、系统及车辆 | |
RU2568777C2 (ru) | Устройство обнаружения движущихся тел и система обнаружения движущихся тел | |
CN108189838A (zh) | 一种融合型自适应巡航弯道控制方法及装置 | |
CN106845332B (zh) | 利用轮胎旁溅的基于视觉的潮湿路面状况检测 | |
CN107139922B (zh) | 一种汽车防追尾方法 | |
JP5846109B2 (ja) | 衝突判定装置及び衝突回避システム | |
CN106679633B (zh) | 一种车载测距系统及方法 | |
US10192444B2 (en) | Forward collision warning system and method | |
EP3202626A1 (en) | In-vehicle image processing device | |
EP3428902A1 (en) | Image processing device, imaging device, mobile apparatus control system, image processing method, and program | |
CN110682907B (zh) | 一种汽车防追尾控制系统及方法 | |
CN113657265B (zh) | 一种车辆距离探测方法、系统、设备及介质 | |
EP1396833A1 (en) | Vehicle control system, program and method | |
CN110126730A (zh) | 车辆变道提醒方法及系统 | |
WO2009101660A1 (ja) | 車両周辺監視装置、車両、車両周辺監視プログラム | |
CN105512641A (zh) | 一种采用激光雷达扫描法标定雨雪状态下视频中的动态行人及车辆的方法 | |
JP5457224B2 (ja) | 路面状態検出装置 | |
CN113581101A (zh) | 工程车辆事故检测处理方法及装置 | |
CN107036630B (zh) | 一种车辆驾驶预警装置安装角度的自动识别系统及方法 | |
CN112298165A (zh) | 一种基于前向视觉的主动转向控制方法 | |
KR20160133257A (ko) | 차량용 블랙박스 후방카메라를 이용한 측후방 충돌방지 시스템 및 충돌방지방법 | |
CN111414857A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210209 |