CN104709280B - 车辆防撞***及方法 - Google Patents
车辆防撞***及方法 Download PDFInfo
- Publication number
- CN104709280B CN104709280B CN201310683472.7A CN201310683472A CN104709280B CN 104709280 B CN104709280 B CN 104709280B CN 201310683472 A CN201310683472 A CN 201310683472A CN 104709280 B CN104709280 B CN 104709280B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- vehicle
- msup
- mfrac
- 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
- 238000000034 method Methods 0.000 title claims description 14
- 230000004888 barrier function Effects 0.000 claims abstract description 80
- 230000006870 function Effects 0.000 claims description 10
- 230000008859 change Effects 0.000 claims description 7
- 230000009471 action Effects 0.000 claims description 5
- 230000007306 turnover Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 6
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 230000009467 reduction Effects 0.000 description 2
- 230000000087 stabilizing effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000004438 eyesight Effects 0.000 description 1
- 230000002045 lasting effect Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000009131 signaling function Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
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
-
- 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/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种车辆防撞***,包含:一个车速感测单元、一个测距感测单元、一个电子驻刹车单元,及一个控制单元。该车速感测单元用于感测该车辆的速度。该测距感测单元用于感测该车辆周遭的障碍物与车辆的相关距离。该控制单元根据车辆的速度、障碍物与车辆的相关距离来运算该车辆与周遭障碍物的一段碰撞时间,并于该碰撞时间不大于一段刹车时间时,控制该电子驻刹车单元提供车辆刹车辅助。通过设置该电子驻刹车单元并搭配该车速感测单元、该测距感测单元,可以在低速的倒车或停车状况下,执行刹车辅助以避免车辆碰撞情形,并能减少***设置成本。
Description
技术领域
本发明涉及一种防撞***及方法,特别是涉及一种车辆防撞***及方法。
背景技术
当驾驶人坐在车子内部时,由于人眼视线有角度限制,无法同时兼顾前后左右各个方位,尤其在停车及倒车时,往往因为驾驶人没有注意或视线无法同时顾及,而容易有碰撞的情形产生,因此如何防止车辆碰撞即为厂商主要研究目标之一。
早期的车辆防撞技术为被动安全警示,当车辆过于靠近障碍物时,会产生警示以提醒驾驶人注意,目前则演进为主动自动紧急刹车,并多半采用液压刹车控制***或是电子稳定***(Electronic StabilityProgram,缩写为ESP,也称电子车身稳定***)搭配距离感测器使用,然而无论是液压刹车控制***或是电子稳定***,皆具有成本高昂且控制方式复杂的问题。
发明内容
本发明的目的在于提供一种可解决上述问题的车辆防撞***。
本发明车辆防撞***适用于设置于一个车辆,该车辆防撞***包含:一个车速感测单元、一个测距感测单元,及一个电子驻刹车单元。
该车速感测单元用于感测该车辆的速度并输出一个对应的车辆速度讯号。
该测距感测单元用于感测该车辆周遭的障碍物与车辆的相关距离并输出一个对应的测距讯号。
该电子驻刹车单元用于接收一个控制信号并根据该控制信号控制该车辆的刹车功能。
该车辆防撞***还包含一个控制单元,该控制单元分别电连接该车速感测单元、该测距感测单元,及该电子驻刹车单元,分别接收该车辆速度讯号、该测距讯号,并根据该车辆速度讯号、该测距讯号运算该车辆与周遭的障碍物的一段碰撞时间,并于该碰撞时间不大于一段刹车时间时,输出该控制信号。
本发明所述车辆防撞***,该车辆防撞***还包含一个电连接该控制单元的警示单元,该控制单元于该碰撞时间不大于该刹车时间与一段警示时间的和时,控制该警示单元输出一个警示信号。
本发明所述车辆防撞***,该控制单元根据该车辆速度讯号运算一个呈椭圆的车辆移动区域,公式如下:
ac=vct,
bc=Wc,
其中,xc、yc为车辆移动区域的外缘坐标,hc、kc为车辆移动区域的中心坐标,ac为椭圆长轴,bc为椭圆短轴,vc为该车辆速度讯号所对应的车辆速度,t为一段预定时间,Wc为该车辆的宽度。
本发明所述车辆防撞***,该控制单元于该测距讯号所对应的障碍物为移动状态时,根据该测距讯号运算一个呈椭圆的障碍物移动区域,公式如下:
ab=vbt,
bb=Wb,
其中,xb、yb为障碍物移动区域的外缘坐标,hb、kb为障碍物移动区域的中心坐标,ab为椭圆长轴,bb为椭圆短轴,vb为该测距讯号所对应的障碍物移动速度,t为一段预定时间,Wb为该障碍物的宽度。
本发明所述车辆防撞***,该控制单元根据该车辆移动区域及该障碍物移动区域运算该车辆是否会碰撞该障碍物,及运算该碰撞时间,运算该车辆是否会碰撞该障碍物的公式如下:
于m不大于1时判断该车辆将会碰撞该障碍物。
本发明所述车辆防撞***,该控制单元所运算的车辆移动区域会随该车辆移动的路径而变化,车辆于倒车时的路径公式如下:
其中,xr、yr为随时间变化的车辆坐标,xr0、yr0为初始的车辆坐标,VL、VR分别为该车辆的左后轮、右后轮的轮速,ΔT为取样时间,θ为该车辆的转向角。
本发明所述车辆防撞***,该车辆于该刹车时间所行驶的距离的公式为:
其中,am为刹车减速度,t_delay为刹车作动延迟时间。
本发明的目的在于提供一种车辆防撞方法。
本发明车辆防撞方法包含以下步骤:
(A)感测车辆速度并输出一个车辆速度讯号,感测该车辆周遭的障碍物与车辆的相关距离并输出一个对应的测距讯号。
(B)根据该车辆速度讯号、该测距讯号运算该车辆与周遭的障碍物的一段碰撞时间。
(C)于该碰撞时间不大于一段刹车时间时,控制一个电子驻刹车单元以控制该车辆的刹车功能。
本发明所述车辆防撞方法,还包含下列步骤:
(D)于该碰撞时间不大于该刹车时间与一段警示时间的和时,输出一个警示信号。
本发明所述车辆防撞***,于步骤(B)中,根据该车辆速度讯号运算一个呈椭圆的车辆移动区域,公式如下:
ac=vct,
bc=Wc,
其中,xc、yc为车辆移动区域的外缘坐标,hc、kc为车辆移动区域的中心坐标,ac为椭圆长轴,bc为椭圆短轴,vc为该车辆速度讯号所对应的车辆速度,t为一段预定时间,Wc为该车辆的宽度。
本发明所述车辆防撞***,于步骤(B)中,于该测距讯号所对应的障碍物为移动状态时,根据该测距讯号运算一个呈椭圆的障碍物移动区域,公式如下:
ab=vbt,
bb=Wb,
其中,xb、yb为障碍物移动区域的外缘坐标,hb、kb为障碍物移动区域的中心坐标,ab为椭圆长轴,bb为椭圆短轴,vb为该测距讯号所对应的障碍物移动速度,t为一段预定时间,Wb为该障碍物的宽度。
本发明所述车辆防撞***,于步骤(B)中,根据该车辆移动区域及该障碍物移动区域运算该车辆是否会碰撞该障碍物,及运算该碰撞时间,运算该车辆是否会碰撞该障碍物的公式如下:
于m不大于1时判断该车辆将会碰撞该障碍物。
本发明所述车辆防撞***,于步骤(B)中,所运算的车辆移动区域会随该车辆移动的路径而变化,车辆于倒车时的路径公式如下:
其中,xr、yr为车辆随时间变化的坐标,xr0、yr0为车辆的初始坐标,VL、VR分别为该车辆的左后轮、右后轮的轮速,ΔT为取样时间,θ为该车辆的转向角。
本发明所述车辆防撞***,于步骤(C)中,该车辆于该刹车时间所行驶的距离的公式为:
其中,am为刹车减速度,t_delay为刹车作动延迟时间。
本发明的有益效果在于:通过设置该电子驻刹车单元并搭配该车速感测单元、该测距感测单元,可以在低速的倒车或停车状况下,若驾驶分心或遭遇紧急情况时,进行刹车辅助以避免车辆碰撞情形,并能减少***设置成本、降低***控制上的复杂度。
附图说明
图1是本发明车辆防撞***的一个较佳实施例的方块示意图;
图2是一个示意图,说明该较佳实施例中所运算的一个车辆移动区域及一个障碍物移动区域;
图3是一个示意图,说明该较佳实施例于输出一个警示信号及自动刹车的时间;
图4是一个示意图,说明该较佳实施例的一个控制单元所运算的车辆移动区域会随该车辆移动的路径而变化;
图5是一个示意图,说明该较佳实施例所适用的场景;及
图6是本发明车辆防撞方法的一个流程图。
具体实施方式
下面结合附图及实施例对本发明进行详细说明。
参阅图1及图2,本发明车辆防撞***的较佳实施例适用于设置于一个车辆9,该车辆防撞***包含:一个车速感测单元2、一个测距感测单元3、一个电子驻刹车单元4(ElectronicParkingBrake,缩写为EPB)、一个警示单元5,及一个控制单元6。
该车速感测单元2用于感测该车辆9的速度并输出一个对应的车辆速度讯号。
该测距感测单元3用于感测该车辆9周遭的障碍物8与车辆9的相关距离并输出一个对应的测距讯号,该测距感测单元3可使用雷达(Radar)或光达(LightDetectionAndRanging,缩写为LiDAR,又称空载雷射测距技术)来实施,但也可为其他可以感测物体距离的技术,并不限于此。
该电子驻刹车单元4用于接收一个控制信号并根据该控制信号控制该车辆9的刹车功能。
参阅图1、图2及图3,该控制单元6分别电连接该车速感测单元2、该测距感测单元3、该电子驻刹车单元4,及该警示单元5,分别接收该车辆速度讯号、该测距讯号,并根据该车辆速度讯号、该测距讯号运算该车辆9与障碍物8的一段碰撞时间,并于该碰撞时间不大于一段刹车时间时输出该控制信号以控制该车辆9的刹车功能。
于本实施例中,该控制单元6于该碰撞时间不大于该刹车时间与一段警示时间的和且大于该刹车时间时,控制该警示单元5输出一个警示信号以提醒驾驶人注意,于该碰撞时间不大于该刹车时间时则输出该控制信号进行自动刹车,但也可于该碰撞时间不大于该刹车时间与该警示时间的和时持续控制该警示单元5输出该警示信号以提醒驾驶人注意,并不限于此。
其中,该刹车时间可根据该车辆速度讯号所对应的车辆速度及车辆9的刹车减速度计算,其公式如下:vc
(公式1)
其中,vc为该车辆速度讯号所对应的车辆速度,am为刹车减速度,该车辆9于该刹车时间所行驶的距离的公式为:
(公式2)
其中,t_delay为刹车作动延迟时间。
参阅图1及图2,于本实施例中,该控制单元6应用椭圆公式并根据该车辆速度讯号运算一个呈椭圆的车辆移动区域,公式如下:
(公式3)
ac=vct (公式4)
bc=Wc (公式5)
其中,xc、yc为车辆移动区域的外缘坐标,hc、kc为车辆移动区域的中心坐标,ac为椭圆长轴,bc为椭圆短轴,vc为该车辆速度讯号所对应的车辆速度,t为一段预定时间,Wc为该车辆9的宽度。
图2中以移动中的人体来说明障碍物8,于该测距讯号所对应的障碍物8为移动状态时,该控制单元6应用椭圆公式并根据该测距讯号运算一个呈椭圆的障碍物移动区域,公式如下:
(公式6)
ab=vbt (公式7)
bb=Wb (公式8)
其中,xb、yb为障碍物移动区域的外缘坐标,hb、kb为障碍物移动区域的中心坐标,ab为椭圆长轴,bb为椭圆短轴,vb为该测距讯号所对应的障碍物8移动速度,t为一段预定时间,Wb为该障碍物8的宽度。
该控制单元6根据该车辆移动区域及该障碍物移动区域运算该车辆9是否会碰撞该障碍物8,及运算该碰撞时间,其中,运算该车辆9是否会碰撞该障碍物8的公式如下:
(公式9)
于m不大于1时,即表示车辆移动区域与障碍物移动区域的椭圆外框会相交,也就是说该车辆9将会碰撞该障碍物8。
参阅图1与图4,当车辆9进行转向时,该控制单元6所运算的车辆移动区域也会随该车辆9移动的路径而变化,图4中所示即为车辆9于倒车直行、倒车右弯、倒车左弯的三种可能路径示意,椭圆区域分别表示该障碍物8、该车辆9于时间t0~t3的障碍物移动区域及车辆移动区域,其中,车辆9于倒车时的路径公式如下:
(公式10)
(公式11)
其中,xr、yr为随时间变化的车辆9坐标,xr0、yr0为初始的车辆9坐标,VL、VR分别为该车辆9的左后轮、右后轮的轮速,ΔT为取样时间,θ为该车辆9的转向角。
参阅图1、图3及图4,当驾驶人进行停车或倒车时,该控制单元6会根据该测距感测单元3所输出的测距讯号运算车辆9周遭的障碍物8的位置,当障碍物8为移动状态时,则运算该障碍物移动区域,并根据车辆9的转弯角度及该车速感测单元2所输出的车辆速度讯号来运算该车辆移动区域,并判断车辆9与该障碍物8是否会产生碰撞、会于几秒后产生碰撞,及依目前的车速所需的刹车时间,如图3及图4所示,若初始时间点为t0,且该控制单元6根据该车辆9与该障碍物8的距离、该车辆9的速度、该障碍物8的速度判断若车辆9持续倒车左弯,在时间点t3时会有产生碰撞的可能,则该控制单元6于时间点t1开始会控制该警示单元5输出该警示信号以提醒驾驶人注意,若驾驶人仍未改变车辆9方向或踩刹车,而导致产生碰撞的可能未被消除,则该控制单元6于时间点t2开始进行自动刹车,输出该控制信号以使该电子驻刹车单元4控制车辆9的刹车功能,如此,则可在驾驶分心或紧急情况下仍可维持行车安全。
参阅图5,为本实施例所适用的情况示意图,由图5中可见,无论是平行停车、倒车入库,或是倒车行进时,皆适于应用本实施例以避免碰撞情形发生。
经由以上的说明,可将本实施例的优点归纳如下:
一、通过设置该电子驻刹车单元4并搭配该车速感测单元2、该测距感测单元3,可以感测车辆9本身速度,及感测车辆9周遭的障碍物8的位置及状态,可以在低速的倒车或停车状况下,当驾驶分心或有紧急情况时,警示驾驶者、提供刹车辅助功能,或是执行刹车动作,有效避免车辆9碰撞的情形发生,且电子驻刹车单元4为目前车辆9上渐趋普及的配备,通过使用该电子驻刹车单元4提供刹车辅助功能,以进行预刹车动作或提供部分刹车,相较于现有技术使用液压刹车控制***或是电子稳定***,可减少***设置成本,并降低***控制上的复杂度。
二、于延伸应用上,本实施例可与自动停车***、停车辅助***进行整合以达到更加完整的功能,或可搭配紧急刹车***(AutonomousEmergencyBraking,缩写为AEB)而更加提升行车安全,具有市场推广上的潜在优势。
参阅图1及图6,本发明车辆防撞方法的较佳实施例运用于上述的车辆防撞***,该方法包含下列步骤:
步骤71:感测车辆速度并输出一个车辆速度讯号,感测该车辆9周遭的障碍物8与车辆9的相关距离并输出一个对应的测距讯号。
步骤72:根据该车辆速度讯号、该测距讯号运算该车辆9与周遭的障碍物8的一段碰撞时间。
在步骤72中,所述车辆防撞***根据该车辆速度讯号运算一个呈椭圆的车辆移动区域,公式如(公式3)、(公式4)、(公式5)所示;于该测距讯号所对应的障碍物8为移动状态时,所述车辆防撞***根据该测距讯号运算一个呈椭圆的障碍物移动区域,公式如(公式6)、(公式7)、(公式8)所示;根据该车辆移动区域及该障碍物移动区域运算该车辆是否会碰撞该障碍物,及运算该碰撞时间,运算该车辆是否会碰撞该障碍物的公式如(公式9)所示,m不大于1时判断该车辆将会碰撞该障碍物;所运算的车辆移动区域会随该车辆移动的路径而变化时,车辆于倒车时的路径公式如(公式10)、(公式11)所示。步骤73:于该碰撞时间不大于该刹车时间与一段警示时间的和时,输出一个警示信号。
步骤74:于该碰撞时间不大于一段刹车时间时,控制一个电子驻刹车单元4以控制该车辆9的刹车功能。
在步骤74中,该车辆于该刹车时间所行驶的距离的公式如(公式2)所示。
综上所述,本实施例不仅可以有效避免车辆9碰撞的现象、减少***设置成本、降低***控制上的复杂度,且具有市场推广上的潜在优势,所以确实能达成本发明的目的。
Claims (6)
1.一种车辆防撞***,适用于设置于一个车辆,该车辆防撞***包含:一个车速感测单元、一个测距感测单元,及一个电子驻刹车单元;
该车速感测单元用于感测该车辆的速度并输出一个对应的车辆速度讯号;
该测距感测单元用于感测该车辆周遭的障碍物与车辆的相关距离并输出一个对应的测距讯号;
其特征在于:
该电子驻刹车单元用于接收一个控制信号并根据该控制信号控制该车辆的刹车功能;
该车辆防撞***还包含一个控制单元,该控制单元分别电连接该车速感测单元、该测距感测单元,及该电子驻刹车单元,分别接收该车辆速度讯号、该测距讯号,并根据该车辆速度讯号、该测距讯号运算该车辆与周遭的障碍物的一段碰撞时间,并于该碰撞时间不大于一段刹车时间时,输出该控制信号;
该车辆防撞***还包含一个电连接该控制单元的警示单元,该控制单元于该碰撞时间不大于该刹车时间与一段警示时间的和时,控制该警示单元输出一个警示信号;
该控制单元根据该车辆速度讯号运算一个呈椭圆的车辆移动区域,公式如下:
<mrow>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>c</mi>
</msub>
<mo>-</mo>
<msub>
<mi>h</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>a</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>c</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>b</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
</mrow>
ac=vct,
bc=Wc,
其中,xc、yc为车辆移动区域的外缘坐标,hc、kc为车辆移动区域的中心坐标,ac为椭圆长轴,bc为椭圆短轴,vc为该车辆速度讯号所对应的车辆速度,t为一段预定时间,Wc为该车辆的宽度,
该控制单元于该测距讯号所对应的障碍物为移动状态时,根据该测距讯号运算一个呈椭圆的障碍物移动区域,公式如下:
<mrow>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>h</mi>
<mi>b</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>a</mi>
<mi>b</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mi>b</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>b</mi>
<mi>b</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
</mrow>
ab=vbt,
bb=Wb,
其中,xb、yb为障碍物移动区域的外缘坐标,hb、kb为障碍物移动区域的中心坐标,ab为椭圆长轴,bb为椭圆短轴,vb为该测距讯号所对应的障碍物移动速度,t为一段预定时间,Wb为该障碍物的宽度,
该控制单元根据该车辆移动区域及该障碍物移动区域运算该车辆是否会碰撞该障碍物,及运算该碰撞时间,运算该车辆是否会碰撞该障碍物的公式如下:
<mrow>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<msup>
<msub>
<mi>a</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<msup>
<msub>
<mi>b</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>=</mo>
<mi>m</mi>
<mo>,</mo>
</mrow>
于m不大于1时判断该车辆将会碰撞该障碍物。
2.如权利要求1所述的车辆防撞***,其特征在于:该控制单元所运算的车辆移动区域会随该车辆移动的路径而变化,车辆于倒车时的路径公式如下:
<mrow>
<msub>
<mi>x</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>&Delta;</mi>
<mi>T</mi>
</mrow>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>V</mi>
<mi>L</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>R</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>r</mi>
<mn>0</mn>
</mrow>
</msub>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>y</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>&Delta;</mi>
<mi>T</mi>
</mrow>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>V</mi>
<mi>L</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>R</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>r</mi>
<mn>0</mn>
</mrow>
</msub>
<mo>,</mo>
</mrow>
其中,xr、yr为随时间变化的车辆坐标,xr0、yr0为初始的车辆坐标,VL、VR分别为该车辆的左后轮、右后轮的轮速,△T为取样时间,θ为该车辆的转向角。
3.如权利要求2所述的车辆防撞***,其特征在于:该车辆于该刹车时间所行驶的距离的公式为:
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>v</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
<mo>/</mo>
<msub>
<mi>a</mi>
<mi>m</mi>
</msub>
</mrow>
<mn>2</mn>
</mfrac>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>c</mi>
</msub>
<mo>&times;</mo>
<mi>t</mi>
<mo>_</mo>
<mi>d</mi>
<mi>e</mi>
<mi>l</mi>
<mi>a</mi>
<mi>y</mi>
<mo>,</mo>
</mrow>
其中,am为刹车减速度,t_delay为刹车作动延迟时间。
4.一种车辆防撞方法,其特征在于:
该车辆防撞方法包含以下步骤:
(A)感测车辆速度并输出一个车辆速度讯号,感测该车辆周遭的障碍物与车辆的相关距离并输出一个对应的测距讯号;
(B)根据该车辆速度讯号、该测距讯号运算该车辆与周遭的障碍物的一段碰撞时间;
(C)于该碰撞时间不大于一段刹车时间时,控制一个电子驻刹车单元以控制该车辆的刹车功能;及
(D)于该碰撞时间不大于该刹车时间与一段警示时间的和时,输出一个警示信号;
于步骤(B)中,根据该车辆速度讯号运算一个呈椭圆的车辆移动区域,公式如下:
<mrow>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>c</mi>
</msub>
<mo>-</mo>
<msub>
<mi>h</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>a</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>c</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>b</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
</mrow>
ac=vct,
bc=Wc,
其中,xc、yc为车辆移动区域的外缘坐标,hc、kc为车辆移动区域的中心坐标,ac为椭圆长轴,bc为椭圆短轴,vc为该车辆速度讯号所对应的车辆速度,t为一段预定时间,Wc为该车辆的宽度
于该测距讯号所对应的障碍物为移动状态时,根据该测距讯号运算一个呈椭圆的障碍物移动区域,公式如下:
<mrow>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>h</mi>
<mi>b</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>a</mi>
<mi>b</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mi>b</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mrow>
<msup>
<msub>
<mi>b</mi>
<mi>b</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
</mrow>
ab=vbt,
bb=Wb,
其中,xb、yb为障碍物移动区域的外缘坐标,hb、kb为障碍物移动区域的中心坐标,ab为椭圆长轴,bb为椭圆短轴,vb为该测距讯号所对应的障碍物移动速度,t为一段预定时间,Wb为该障碍物的宽度,
根据该车辆移动区域及该障碍物移动区域运算该车辆是否会碰撞该障碍物,及运算该碰撞时间,
运算该车辆是否会碰撞该障碍物的公式如下:
<mrow>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<msup>
<msub>
<mi>a</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>c</mi>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<msup>
<msub>
<mi>b</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>=</mo>
<mi>m</mi>
<mo>,</mo>
</mrow>
于m不大于1时判断该车辆将会碰撞该障碍物。
5.如权利要求4所述的车辆防撞方法,其特征在于:于步骤(B)中,所运算的车辆移动区域会随该车辆移动的路径而变化,车辆于倒车时的路径公式如下:
<mrow>
<msub>
<mi>x</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>&Delta;</mi>
<mi>T</mi>
</mrow>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>V</mi>
<mi>L</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>R</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>r</mi>
<mn>0</mn>
</mrow>
</msub>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>y</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>&Delta;</mi>
<mi>T</mi>
</mrow>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>V</mi>
<mi>L</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>R</mi>
</msub>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>r</mi>
<mn>0</mn>
</mrow>
</msub>
<mo>,</mo>
</mrow>
其中,xr、yr为车辆随时间变化的坐标,xr0、yr0为车辆的初始坐标,VL、VR分别为该车辆的左后轮、右后轮的轮速,△T为取样时间,θ为该车辆的转向角。
6.如权利要求5所述的车辆防撞方法,其特征在于:于步骤(C)中,该车辆于该刹车时间所行驶的距离的公式为:
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>v</mi>
<mi>c</mi>
</msub>
<mn>2</mn>
</msup>
<mo>/</mo>
<msub>
<mi>a</mi>
<mi>m</mi>
</msub>
</mrow>
<mn>2</mn>
</mfrac>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>c</mi>
</msub>
<mo>&times;</mo>
<mi>t</mi>
<mo>_</mo>
<mi>d</mi>
<mi>e</mi>
<mi>l</mi>
<mi>a</mi>
<mi>y</mi>
<mo>,</mo>
</mrow>
其中,am为刹车减速度,t_delay为刹车作动延迟时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310683472.7A CN104709280B (zh) | 2013-12-13 | 2013-12-13 | 车辆防撞***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310683472.7A CN104709280B (zh) | 2013-12-13 | 2013-12-13 | 车辆防撞***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104709280A CN104709280A (zh) | 2015-06-17 |
CN104709280B true CN104709280B (zh) | 2018-03-16 |
Family
ID=53409145
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310683472.7A Active CN104709280B (zh) | 2013-12-13 | 2013-12-13 | 车辆防撞***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104709280B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102015212250A1 (de) * | 2015-06-30 | 2017-01-05 | Conti Temic Microelectronic Gmbh | Verbesserte Berechnung der Zeit bis zur Kollision für ein Fahrzeug |
CN109591816B (zh) * | 2016-10-14 | 2020-06-12 | 成都鹰明智通科技股份有限公司 | 基于视频分析避免汽车与目标运动体相撞的控制方法 |
CN107862903B (zh) * | 2017-12-08 | 2020-03-31 | 财团法人车辆研究测试中心 | 物体碰撞预测方法及其装置 |
CN109001718A (zh) * | 2018-06-22 | 2018-12-14 | 安徽尼古拉电子科技有限公司 | 一种基于多普勒原理的雷达测距方法 |
CN111114340B (zh) * | 2018-10-31 | 2021-11-02 | 宝沃汽车(中国)有限公司 | 用于车辆的安全控制方法、装置及车辆 |
CN109901193A (zh) * | 2018-12-03 | 2019-06-18 | 财团法人车辆研究测试中心 | 近距离障碍物的光达侦测装置及其方法 |
CN112158181A (zh) * | 2020-09-29 | 2021-01-01 | 奇瑞汽车股份有限公司 | 车辆制动的方法和装置 |
CN113353069B (zh) * | 2021-07-22 | 2023-03-24 | 中国第一汽车股份有限公司 | 自动紧急制动***、自动紧急制动***的调校方法及*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102632887A (zh) * | 2011-02-08 | 2012-08-15 | 沃尔沃汽车公司 | 车载感知***、防撞***、车辆、物体状态改变评价方法 |
CN202703577U (zh) * | 2012-06-21 | 2013-01-30 | 郑州宇通客车股份有限公司 | 一种汽车智能刹车控制*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10356309A1 (de) * | 2003-11-28 | 2005-06-23 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Warnung des Fahrers eines Kraftfahrzeugs |
-
2013
- 2013-12-13 CN CN201310683472.7A patent/CN104709280B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102632887A (zh) * | 2011-02-08 | 2012-08-15 | 沃尔沃汽车公司 | 车载感知***、防撞***、车辆、物体状态改变评价方法 |
CN202703577U (zh) * | 2012-06-21 | 2013-01-30 | 郑州宇通客车股份有限公司 | 一种汽车智能刹车控制*** |
Also Published As
Publication number | Publication date |
---|---|
CN104709280A (zh) | 2015-06-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104709280B (zh) | 车辆防撞***及方法 | |
KR102598960B1 (ko) | 차량의 주행 제어 장치 및 방법 | |
CN104798123B (zh) | 驾驶辅助装置以及驾驶辅助方法 | |
CN105492262B (zh) | 车辆控制方法及车辆控制*** | |
CN103140408B (zh) | 车辆操作状态确定***、驾驶辅助***和操作状态确定方法 | |
CN102887147B (zh) | 用于车辆的对象识别和主动安全控制 | |
CN103818378B (zh) | 主动安全***和操作该***的方法 | |
CN103477378B (zh) | 驾驶辅助装置 | |
US8396642B2 (en) | Adaptive cruise control system | |
JP5790442B2 (ja) | 運転支援装置及び運転支援方法 | |
CN111372826A (zh) | 车辆的制动辅助装置、控制装置以及制动辅助方法 | |
CN110654377A (zh) | 一种车辆防撞控制方法及控制*** | |
CN104024074A (zh) | 车辆的驾驶支援装置 | |
CN105050884B (zh) | 碰撞避免辅助装置和碰撞避免辅助方法 | |
CN110920618A (zh) | 车辆的控制***以及车辆的控制方法 | |
JP2012192862A (ja) | 車両制御装置 | |
CN111674348A (zh) | 一种缓冲车辆碰撞的方法、装置及车辆 | |
JP2019206258A (ja) | 車両制御システム | |
EP1852323A1 (en) | Rear end collision mitigation system for an automotive vehicle | |
CN110576853A (zh) | 车辆控制*** | |
CN110641460A (zh) | 车辆控制*** | |
JP2011000936A (ja) | 衝突安全装置 | |
CN110920600A (zh) | 四轮驱动车辆的控制***以及四轮驱动车辆的控制方法 | |
KR102083141B1 (ko) | 후측방 레이더 센서를 이용한 차선 유지 보조 장치 및 방법 | |
CN115195741A (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 |