CN110040138A - 一种车辆并行辅助驾驶方法和*** - Google Patents
一种车辆并行辅助驾驶方法和*** Download PDFInfo
- Publication number
- CN110040138A CN110040138A CN201910314983.9A CN201910314983A CN110040138A CN 110040138 A CN110040138 A CN 110040138A CN 201910314983 A CN201910314983 A CN 201910314983A CN 110040138 A CN110040138 A CN 110040138A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- users
- parallel
- fellow road
- speed
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000003044 adaptive effect Effects 0.000 claims description 22
- 238000013439 planning Methods 0.000 claims description 21
- 238000011084 recovery Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 abstract description 9
- 230000007613 environmental effect Effects 0.000 abstract description 6
- 230000006870 function Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 3
- 230000008447 perception Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000006467 substitution reaction Methods 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/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
- B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
-
- 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
-
- 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
-
- 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/12—Lateral speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明实施例涉及一种车辆并行辅助驾驶方法和***,包括:首先,由车载传感器获取自车状态和车辆周边的环境信息,主要包括自车速度和周边车辆的位置、速度信息;然后,车载运算单元根据获取到的自车和环境信息,计算出车辆避开并行状态的加减速需求;最后,车辆控制单元接收该加减速需求后对车辆油门和制动***进行主动控制,调节车辆速度,从而实现并行辅助的功能,这样在遇到并行状态时能够主动调节车速,进而与邻车道车辆在纵向上错开位置,能够避免车辆进入长时间并行状态,提高了行车安全性并且满足人类的驾驶习惯。
Description
技术领域
本发明涉及自动驾驶领域,尤其涉及一种车辆并行辅助驾驶方法和***。
背景技术
随着中国车辆市场的快速增长,驾驶辅助***被广泛研究。其中,某些纵向高级驾驶辅助***已经取得商业化应用,一定程度上降低了驾驶员负荷。
车道保持中一个场景是相邻车道存在车辆与自车并行,而车辆长时间并行是一种风险较大的行驶状态,一旦发生突发状况可能导致严重的交通事故,一般人类驾驶员会尽量避开这种状况。为了提高行车安全性,需要一种车辆并行辅助驾驶***,在发生或即将发生车辆长时间并行时及时调节车速,避免车辆进入并行状态。
现有的纵向高级驾驶辅助***功能最常见的有TJA(交通拥堵辅助)、ACC(自适应巡航)、AEB(自动紧急刹车)和CC(定速巡航),其中TJA、ACC和AEB都是根据前车位置和速度控制自车加减速,从而实现跟车和防撞等功能,CC则是根据设定的期望车速对车辆加减速进行控制。
上述纵向高级驾驶辅助***只关注前车位置速度和自车期望车速,没有考虑相邻车道的车辆状态,因此自车处于并行状态时不具有主动速度调节功能,存在安全隐患而且降低了乘坐体验。
发明内容
本发明的目的是针对现有技术的缺陷,提供一种车辆并行辅助驾驶方法和***,在遇到并行状态时主动调节车速,从而与邻车道车辆在纵向上错开位置,能够避免车辆进入长时间并行状态,提高了行车安全性并且满足人类的驾驶习惯。
有鉴于此,第一方面,本发明实施例提供了一种车辆并行辅助驾驶方法,包括:
获取车载传感单元采集的自车状态信息和车辆周围的环境感知信息;所述自车状态信息包括自车的速度信息,所述环境感知信息包括自车周围车辆的状态信息;
根据所述环境感知信息判断自车前方是否存在车辆;
当所述自车前方存在车辆时,进入自适应巡航模式;
在所述自适应巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;
当所述相邻车道存在车辆时,根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹;
根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;
当自车与相邻车道车辆长时间并行时,重新计算跟车间距,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行;
当所述自车前方不存在车辆时,进入定速巡航模式;
在所述定速巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;
当所述相邻车道存在车辆时,根据所述自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹;
根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;
当自车与相邻车道车辆长时间并行时,重新计算巡航期望车速,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行。
优选的,在所述根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行之前,所述方法还包括:
根据所述邻车道车辆的位置和速度信息计算所述邻车道车辆的未来行驶轨迹。
进一步优选的,所述根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行具体包括:
基于所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹,根据预设步长计算所述自车和相邻车道车辆纵向位置的差值,统计差值低于预设距离的连续时长;
根据所述连续时长是否超过预设时间阈值判断所述自车与相邻车道车辆是否长时间并行。
优选的,在根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述方法还包括:
根据所述自适应巡航模式恢复跟车。
优选的,在根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述方法还包括:
根据所述定速应巡航模式恢复定速巡航。
第二方面,本发明实施例提供了一种车辆并行辅助驾驶***,包括:车载传感单元、车载运算单元和车辆控制单元;
所述车载传感单元,用于采集的自车状态信息和车辆周围的环境感知信息,并发送给所述车载运算单元;所述自车状态信息包括自车的速度信息,所述环境感知信息包括自车周围车辆的状态信息;
所述车载运算单元,用于根据所述环境感知信息判断自车前方是否存在车辆;
当所述自车前方存在车辆时,进入自适应巡航模式;在所述自适应巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;当所述相邻车道存在车辆时,根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹;根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;当自车与相邻车道车辆长时间并行时,重新计算跟车间距,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行,将所述第一速度曲线发送给所述车辆控制单元;
当所述自车前方不存在车辆时,进入定速巡航模式;在所述定速巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;当所述相邻车道存在车辆时,根据所述自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹;根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;当自车与相邻车道车辆长时间并行时,重新计算巡航期望车速,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行,将所述第二速度曲线发送给所述车辆控制单元;
所述车辆控制单元,用于根据第一速度曲线或第二速度曲线调节所述自车的速度。
优选的,所述车载运算单元还用于根据所述邻车道车辆的位置和速度信息计算所述邻车道车辆的未来行驶轨迹。
进一步优选的,所述车载运算单元具体用于基于所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹,根据预设步长计算所述自车和相邻车道车辆纵向位置的差值,统计差值低于预设距离的连续时长;根据所述连续时长是否超过预设时间阈值判断所述自车与相邻车道车辆是否长时间并行。
优选的,在根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述车载运算单元还用于根据所述自适应巡航模式恢复跟车。
优选的,在根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述车载运算单元还用于根据所述定速应巡航模式恢复定速巡航。
本发明实施例提供的一种车辆并行辅助驾驶方法和***,首先由车载传感器获取自车状态和车辆周边的环境信息,主要包括自车速度和周边车辆的位置、速度信息;车载运算单元根据获取到的自车和环境信息,计算出车辆避开并行状态的加减速需求;最后车辆控制单元接收该加减速需求后对车辆油门和制动***进行主动控制,调节车辆速度,从而实现并行辅助的功能,这样在遇到并行状态时能够主动调节车速,进而与邻车道车辆在纵向上错开位置,能够避免车辆进入长时间并行状态,提高了行车安全性并且满足人类的驾驶习惯。
附图说明
图1为本发明实施例提供的一种车辆并行辅助驾驶方法流程图;
图2为本发明实施例提供的一种感知信息示意图;
图3为本发明实施例提供的一种车辆并行辅助驾驶***的结构示意图。
具体实施方式
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
本发明实施例提供的车辆并行辅助驾驶方法应用于自动驾驶车辆,图1为本发明实施例提供的一种车辆并行辅助驾驶方法流程图,如图1所示,包括:
步骤101,获取车载传感单元采集的自车状态信息和车辆周围的环境感知信息。
在车辆行驶过程中,车载传感单元对自车状态和车辆周围的环境感知信息进行检测,这里的车载传感单元具体可以包括激光雷达、GPS、摄像头、轮速计、IMU等用于行车环境感知的传感器。
其中,自车状态信息可以包括自车的速度信息,环境感知信息可以包括自车周围车辆的状态信息,比如自车相邻车道车辆或前方车辆的车速信息和位置信息等。
步骤102,根据环境感知信息判断自车前方是否存在车辆。
具体的,结合图2所示,根据第一预设距离阈值和自车与前车之间的距离判断df判断自车前方是否存在车辆,这里的第一预设距离阈值是指根据自车与前车预先设定的距离阈值,本领域技术人员可以根据实际需要对第一预设距离阈值进行设定,不同的道路场景可以设定不同的第一预设距离阈值。
当自车与前车之间的车距df不大于第一预设距离阈值时,则认为前方存在车辆,则应进入ACC并行逻辑,执行步骤103。
当自车与前车之间的车距df大于第一预设距离阈值时,则认为前方不存在车辆,则应进入CC并行逻辑,执行步骤108。
当自车前方存在车辆时,步骤103,进入自适应巡航模式。
自适应巡航模式是一种智能化的自动控制,包括ACC并行判断逻辑、ACC并行速度调节逻辑和ACC跟车逻辑,在自车前方存在车辆时,进入ACC并行判断逻辑。在此之后,执行步骤104。
步骤104,在自适应巡航模式下,根据环境感知信息判断相邻车道是否存在车辆。
具体的,根据第二预设距离阈值和自车与相邻车道车辆之间的距离dp判断相邻车道是否存在车辆,这里的第二预设距离阈值是指根据自车与相邻车道车辆预先设定的距离阈值,本领域技术人员可以根据实际需要对第二预设距离阈值进行设定。
当自车与相邻车道车辆之间的距离dp不大于第二预设距离阈值时,则认为相邻车道存在车辆,则需要进行并行速度调节,执行步骤105。
当自车与相邻车道车辆之间的距离dp大于第二预设距离阈值时,则认为相邻车道不存在车辆,则不需要进行并行速度调节,执行步骤113,根据自适应巡航模式恢复跟车。即执行ACC跟车逻辑。
步骤105,根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹。
具体而言,当相邻车道存在车辆时,在ACC车辆并行状态判断逻辑中,车载运算单元根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并根据ACC跟车策略逻辑计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹,这里的未来自车的第一行驶轨迹是指基于ACC跟车策略逻辑计算出的自车将要行驶的路径。
步骤106,根据自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行。
这里的相邻车道车辆的未来行驶轨迹是在步骤106之前计算得到的,具体的,根据环境感知信息中的邻车道车辆的位置和速度信息采用静态或动态预测方法计算邻车道车辆的未来行驶轨迹。
在得到邻车道车辆的未来行驶轨迹之后,基于自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹,根据预设步长计算自车和相邻车道车辆纵向位置的差值,统计差值低于预设距离的连续时长;根据连续时长是否超过预设时间阈值判断自车与相邻车道车辆是否长时间并行。
当连续时长超过预设时间阈值时,判断自车与相邻车道车辆发生或即将发生并行,进入车辆并行速度调节逻辑,具体执行步骤107。
当连续时长没超过预设时间阈值时,判断自车与相邻车道车辆不会发生并行,执行步骤113。
在一个具体的例子中,统计自车和相邻车道车辆纵向差值低于安全距离5米的连续时长,当连续时长超过阈值5秒时,则表示自车发生或即将发生车辆长时间并行状态,进入车辆并行速度调节逻辑,执行步骤107,否则执行步骤113。
步骤107,重新计算跟车间距,并根据相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使自车与相邻车道车辆不存在长时间并行。
当确认自车与相邻车道车辆发生或即将发生长时间并行时,在ACC车辆并行速度调节逻辑中,根据相邻车道车辆的未来行驶轨迹重新计算合适的跟车间距并规划自车未来的第一速度曲线,避开与邻车道车辆并行的状态,直到与邻车道车辆不存在并行风险时,执行步骤113,根据自适应巡航模式恢复跟车。
在上述步骤102之后,当自车前方不存在车辆时,则执行步骤108,进入定速巡航模式。
定速巡航模式是一种以固定的速度行驶的模式,包括CC并行状态判断逻辑、CC车辆并行速度调节逻辑和CC定速逻辑。
步骤109,在定速巡航模式下,根据环境感知信息判断相邻车道是否存在车辆。
在定速巡航模式下的判断相邻车道是否存在车辆的方法与步骤104自适应巡航模式下的判断方法相同,此处不再进行赘述。
当判断相邻车道存在车辆时,进入CC车辆并行状态判断逻辑,执行步骤110。
当判断相邻车道不存在车辆时,执行步骤114,根据定速应巡航模式恢复定速巡航。即执行CC定速逻辑。
步骤110,根据自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹。
当自车与相邻车道车辆长时间并行时,在CC并行状态判断逻辑中,车载运算单元根据自车期望车速、自车实际车速计算出未来自车的第二行驶轨迹,这里的未来自车的第二行驶轨迹是指基于CC并行状态判断逻辑计算出的自车将要行驶的路径。
步骤111,根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行。
相邻车道车辆的未来行驶轨迹的获取与上述步骤106的获取方法相同,此处不再进行赘述。
根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行与上述步骤106中的判断方法相同,此处不再进行赘述。
当连续时长超过预设时间阈值时,判断自车与相邻车道车辆发生或即将发生并行,进入CC车辆并行速度调节逻辑,具体执行步骤112。
当连续时长没超过预设时间阈值时,判断自车与相邻车道车辆不会发生并行,执行步骤114。
步骤112,重新计算巡航期望车速,并根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使自车与相邻车道车辆不存在长时间并行。
当自车与相邻车道车辆长时间并行时,根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线重新计算合适的巡航期望车速,并规划未来的第二速度曲线,强制加速或减速后再恢复至原来的期望车速,使自车与相邻车道车辆不存在长时间并行,避开与邻车道车辆并行的状态,直到与邻车道车辆不存在并行风险时,执行步骤114,根据定速应巡航模式恢复定速巡航。
在对本发明实施例提供的一种车辆并行辅助驾驶方法了解的基础上,下面对本发明实施例提供的一种车辆并行辅助驾驶***进行介绍。
图3为本发明实施例提供的一种车辆并行辅助驾驶***的结构示意图,如图3所示,***包括车载传感单元1、车载运算单元2和车辆控制单元3。
车载传感单元1,用于采集的自车状态信息和车辆周围的环境感知信息,并发送给车载运算单元2;自车状态信息包括自车的速度信息,环境感知信息包括自车周围车辆的状态信。
车载运算单元2,用于根据环境感知信息判断自车前方是否存在车辆;
当自车前方存在车辆时,进入自适应巡航模式;在自适应巡航模式下,根据环境感知信息判断相邻车道是否存在车辆;当相邻车道存在车辆时,根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹;根据自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行;当自车与相邻车道车辆长时间并行时,重新计算跟车间距,并根据相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使自车与相邻车道车辆不存在长时间并行,将第一速度曲线发送给车辆控制单元。
当自车前方不存在车辆时,进入定速巡航模式;在定速巡航模式下,根据环境感知信息判断相邻车道是否存在车辆;当相邻车道存在车辆时,根据自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹;根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行;当自车与相邻车道车辆长时间并行时,重新计算巡航期望车速,并根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使自车与相邻车道车辆不存在长时间并行,将第二速度曲线发送给车辆控制单元。
车辆控制单元3,用于根据第一速度曲线或第二速度曲线调节自车的速度。
优选的,车载运算单元2还用于根据邻车道车辆的位置和速度信息计算邻车道车辆的未来行驶轨迹。
优选的,车载运算单元2具体用于基于自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹,根据预设步长计算自车和相邻车道车辆纵向位置的差值,统计差值低于预设距离的连续时长;根据连续时长是否超过预设时间阈值判断自车与相邻车道车辆是否长时间并行。
优选的,在根据自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆不存在长时间并行,或者在根据相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使自车与相邻车道车辆不存在长时间并行之后,车载运算单元2还用于根据自适应巡航模式恢复跟车。
优选的,在根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆不存在长时间并行,或者在根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述车载运算单元2还用于根据所述定速应巡航模式恢复定速巡航。
本发明实施例提供的一种车辆并行辅助驾驶***与上述方法一一对应,此处不再进行赘述。
本发明实施例提供的一种车辆并行辅助驾驶方法和***,首先由车载传感器获取自车状态和车辆周边的环境信息,主要包括自车速度和周边车辆的位置、速度信息;车载运算单元根据获取到的自车和环境信息,计算出车辆避开并行状态的加减速需求;最后车辆控制单元接收该加减速需求后对车辆油门和制动***进行主动控制,调节车辆速度,从而实现并行辅助的功能,这样在遇到并行状态时能够主动调节车速,进而与邻车道车辆在纵向上错开位置,能够避免车辆进入长时间并行状态,提高了行车安全性并且满足人类的驾驶习惯。
专业人员应该还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RA车辆并行辅助驾驶***)、内存、只读存储器(RO车辆并行辅助驾驶***)、电可编程RO车辆并行辅助驾驶***、电可擦除可编程RO车辆并行辅助驾驶***、寄存器、硬盘、可移动磁盘、CD-RO车辆并行辅助驾驶***、或技术领域内所公知的任意其它形式的存储介质中。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种车辆并行辅助驾驶方法,其特征在于,所述方法包括:
获取车载传感单元采集的自车状态信息和车辆周围的环境感知信息;所述自车状态信息包括自车的速度信息,所述环境感知信息包括自车周围车辆的状态信息;
根据所述环境感知信息判断自车前方是否存在车辆;
当所述自车前方存在车辆时,进入自适应巡航模式;
在所述自适应巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;
当所述相邻车道存在车辆时,根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹;
根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;
当自车与相邻车道车辆长时间并行时,重新计算跟车间距,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行;
当所述自车前方不存在车辆时,进入定速巡航模式;
在所述定速巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;
当所述相邻车道存在车辆时,根据所述自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹;
根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;
当自车与相邻车道车辆长时间并行时,重新计算巡航期望车速,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行。
2.根据权利要求1所述的车辆并行辅助驾驶方法,其特征在于,在所述根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行之前,所述方法还包括:
根据所述邻车道车辆的位置和速度信息计算所述邻车道车辆的未来行驶轨迹。
3.根据权利要求1或2所述的车辆并行辅助驾驶方法,其特征在于,所述根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行具体包括:
基于所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹,根据预设步长计算所述自车和相邻车道车辆纵向位置的差值,统计差值低于预设距离的连续时长;
根据所述连续时长是否超过预设时间阈值判断所述自车与相邻车道车辆是否长时间并行。
4.根据权利要求1所述的车辆并行辅助驾驶方法,其特征在于,在根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述方法还包括:
根据所述自适应巡航模式恢复跟车。
5.根据权利要求1所述的车辆并行辅助驾驶方法,其特征在于,在根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述方法还包括:
根据所述定速应巡航模式恢复定速巡航。
6.一种基于上述权利要求1-5任一所述方法的车辆并行辅助驾驶***,其特征在于,所述***包括车载传感单元、车载运算单元和车辆控制单元;
所述车载传感单元,用于采集的自车状态信息和车辆周围的环境感知信息,并发送给所述车载运算单元;所述自车状态信息包括自车的速度信息,所述环境感知信息包括自车周围车辆的状态信息;
所述车载运算单元,用于根据所述环境感知信息判断自车前方是否存在车辆;
当所述自车前方存在车辆时,进入自适应巡航模式;在所述自适应巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;当所述相邻车道存在车辆时,根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距,并计算出自车到达期望跟车间距的预计时间,从而计算出未来自车的第一行驶轨迹;根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;当自车与相邻车道车辆长时间并行时,重新计算跟车间距,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行,将所述第一速度曲线发送给所述车辆控制单元;
当所述自车前方不存在车辆时,进入定速巡航模式;在所述定速巡航模式下,根据所述环境感知信息判断相邻车道是否存在车辆;当所述相邻车道存在车辆时,根据所述自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹;根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行;当自车与相邻车道车辆长时间并行时,重新计算巡航期望车速,并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行,将所述第二速度曲线发送给所述车辆控制单元;
所述车辆控制单元,用于根据第一速度曲线或第二速度曲线调节所述自车的速度。
7.根据权利要求6所述的车辆并行辅助驾驶***,其特征在于,所述车载运算单元还用于根据所述邻车道车辆的位置和速度信息计算所述邻车道车辆的未来行驶轨迹。
8.根据权利要求6或7所述的车辆并行辅助驾驶***,其特征在于,所述车载运算单元具体用于基于所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹,根据预设步长计算所述自车和相邻车道车辆纵向位置的差值,统计差值低于预设距离的连续时长;根据所述连续时长是否超过预设时间阈值判断所述自车与相邻车道车辆是否长时间并行。
9.根据权利要求6所述的车辆并行辅助驾驶***,其特征在于,在根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述车载运算单元还用于根据所述自适应巡航模式恢复跟车。
10.根据权利要求6所述的车辆并行辅助驾驶***,其特征在于,在根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行,或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线,使所述自车与相邻车道车辆不存在长时间并行之后,所述车载运算单元还用于根据所述定速应巡航模式恢复定速巡航。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910314983.9A CN110040138B (zh) | 2019-04-18 | 2019-04-18 | 一种车辆并行辅助驾驶方法和*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910314983.9A CN110040138B (zh) | 2019-04-18 | 2019-04-18 | 一种车辆并行辅助驾驶方法和*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110040138A true CN110040138A (zh) | 2019-07-23 |
CN110040138B CN110040138B (zh) | 2020-10-27 |
Family
ID=67277828
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910314983.9A Active CN110040138B (zh) | 2019-04-18 | 2019-04-18 | 一种车辆并行辅助驾驶方法和*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110040138B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110825081A (zh) * | 2019-11-08 | 2020-02-21 | 禾多科技(北京)有限公司 | 应用于自动驾驶高速场景的避免平行驾驶的智能决策方法 |
CN112193247A (zh) * | 2020-10-19 | 2021-01-08 | 重庆长安汽车股份有限公司 | 一种车辆巡航速度的控制方法及控制装置 |
CN112530165A (zh) * | 2020-11-30 | 2021-03-19 | 中国民航信息网络股份有限公司 | 一种基于物联网的机坪保障车辆的违章判断方法和装置 |
CN113220137A (zh) * | 2020-02-04 | 2021-08-06 | 奥迪股份公司 | 移动电子设备辅助使用***、车辆及相应的方法和介质 |
CN115547101A (zh) * | 2022-08-15 | 2022-12-30 | 北京罗克维尔斯科技有限公司 | 一种车辆避让方法、装置、设备、介质及车辆 |
WO2024093321A1 (zh) * | 2022-10-31 | 2024-05-10 | 华为技术有限公司 | 车辆的位置获取方法、模型的训练方法以及相关设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102348592A (zh) * | 2009-04-21 | 2012-02-08 | 丰田自动车株式会社 | 行驶辅助装置 |
CN104192146A (zh) * | 2014-09-12 | 2014-12-10 | 辽宁工业大学 | 基于模糊控制的汽车智能巡航辅助驾驶***控制方法 |
CN106564497A (zh) * | 2015-10-12 | 2017-04-19 | 现代自动车株式会社 | 用于控制主体车辆的方法和装置 |
WO2018105058A1 (ja) * | 2016-12-07 | 2018-06-14 | 本田技研工業株式会社 | 車両制御装置 |
-
2019
- 2019-04-18 CN CN201910314983.9A patent/CN110040138B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102348592A (zh) * | 2009-04-21 | 2012-02-08 | 丰田自动车株式会社 | 行驶辅助装置 |
CN104192146A (zh) * | 2014-09-12 | 2014-12-10 | 辽宁工业大学 | 基于模糊控制的汽车智能巡航辅助驾驶***控制方法 |
CN106564497A (zh) * | 2015-10-12 | 2017-04-19 | 现代自动车株式会社 | 用于控制主体车辆的方法和装置 |
WO2018105058A1 (ja) * | 2016-12-07 | 2018-06-14 | 本田技研工業株式会社 | 車両制御装置 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110825081A (zh) * | 2019-11-08 | 2020-02-21 | 禾多科技(北京)有限公司 | 应用于自动驾驶高速场景的避免平行驾驶的智能决策方法 |
CN110825081B (zh) * | 2019-11-08 | 2021-10-29 | 禾多科技(北京)有限公司 | 应用于自动驾驶高速场景的避免平行驾驶的智能决策方法 |
CN113220137A (zh) * | 2020-02-04 | 2021-08-06 | 奥迪股份公司 | 移动电子设备辅助使用***、车辆及相应的方法和介质 |
CN112193247A (zh) * | 2020-10-19 | 2021-01-08 | 重庆长安汽车股份有限公司 | 一种车辆巡航速度的控制方法及控制装置 |
CN112530165A (zh) * | 2020-11-30 | 2021-03-19 | 中国民航信息网络股份有限公司 | 一种基于物联网的机坪保障车辆的违章判断方法和装置 |
CN112530165B (zh) * | 2020-11-30 | 2022-01-28 | 中国民航信息网络股份有限公司 | 一种基于物联网的机坪保障车辆的违章判断方法和装置 |
CN115547101A (zh) * | 2022-08-15 | 2022-12-30 | 北京罗克维尔斯科技有限公司 | 一种车辆避让方法、装置、设备、介质及车辆 |
WO2024093321A1 (zh) * | 2022-10-31 | 2024-05-10 | 华为技术有限公司 | 车辆的位置获取方法、模型的训练方法以及相关设备 |
Also Published As
Publication number | Publication date |
---|---|
CN110040138B (zh) | 2020-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110040138A (zh) | 一种车辆并行辅助驾驶方法和*** | |
CN109501799B (zh) | 一种车联网条件下的动态路径规划方法 | |
CN107993453B (zh) | 一种基于车路协同的弯道安全车速计算方法 | |
JP5195929B2 (ja) | 隊列走行制御システム及び車両 | |
US7363155B2 (en) | Method and device for warning the driver of a motor vehicle | |
EP3044062B1 (en) | Method and system for adaptive cruise control and vehicle | |
CN110103969A (zh) | 一种车辆控制方法、装置、***及车辆 | |
CN108032858B (zh) | 基于旁车行驶路径预测的自适应巡航控制方法及*** | |
JP5026381B2 (ja) | 加減速制御装置 | |
WO2023139867A1 (ja) | 車両運動制御装置、および、車両運動制御方法 | |
CN113799800B (zh) | 一种无人驾驶车辆自动换道超车轨迹规划方法 | |
EP3674154B1 (en) | Method and apparatus for controlling travel of driving-assisted vehicle | |
JP4873047B2 (ja) | 走行制御装置 | |
EP3674156B1 (en) | Method and device for generating target path for autonomous vehicle | |
CN109017785A (zh) | 车辆换道行驶方法 | |
JP2009061878A (ja) | 走行制御装置 | |
CN109760678A (zh) | 一种汽车自适应巡航***的限速方法 | |
CN112660126B (zh) | 用于自适应巡航的车辆协同控制方法、装置及车辆 | |
CN109035863A (zh) | 车辆强制换道行驶方法 | |
CN116946137A (zh) | 一种基于驾驶意图的车路协同智能车辆换道防碰撞*** | |
CN109085831A (zh) | 车辆协同换道行驶方法 | |
CN112693468A (zh) | 用于机动车的控制***和用于调整控制***的方法 | |
CN112298173A (zh) | 一种面向智能驾驶的车辆安全行驶控制***及控制方法 | |
CN113954827B (zh) | 一种考虑定位误差和通信时延的交叉口车辆碰撞概率计算方法及*** | |
CN110040137A (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 | ||
CP01 | Change in the name or title of a patent holder |
Address after: B4-006, maker Plaza, 338 East Street, Huilongguan town, Changping District, Beijing 100096 Patentee after: Beijing Idriverplus Technology Co.,Ltd. Address before: B4-006, maker Plaza, 338 East Street, Huilongguan town, Changping District, Beijing 100096 Patentee before: Beijing Idriverplus Technology Co.,Ltd. |
|
CP01 | Change in the name or title of a patent holder |