CN110040138B - 一种车辆并行辅助驾驶方法和系统 - Google Patents

一种车辆并行辅助驾驶方法和系统 Download PDF

Info

Publication number
CN110040138B
CN110040138B CN201910314983.9A CN201910314983A CN110040138B CN 110040138 B CN110040138 B CN 110040138B CN 201910314983 A CN201910314983 A CN 201910314983A CN 110040138 B CN110040138 B CN 110040138B
Authority
CN
China
Prior art keywords
vehicle
adjacent lane
speed
parallel
future
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
Application number
CN201910314983.9A
Other languages
English (en)
Other versions
CN110040138A (zh
Inventor
张双琳
徐成
张放
李晓飞
张德兆
王肖
霍舒豪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Idriverplus Technologies Co Ltd
Original Assignee
Beijing Idriverplus Technologies Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Idriverplus Technologies Co Ltd filed Critical Beijing Idriverplus Technologies Co Ltd
Priority to CN201910314983.9A priority Critical patent/CN110040138B/zh
Publication of CN110040138A publication Critical patent/CN110040138A/zh
Application granted granted Critical
Publication of CN110040138B publication Critical patent/CN110040138B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/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车辆并行状态判断逻辑中，车载运算单元根据自车期望车速、自车实际车速Vh、前车位置和前车速度Vf计算出期望跟车间距，并根据ACC跟车策略逻辑计算出自车到达期望跟车间距的预计时间，从而计算出未来自车的第一行驶轨迹，这里的未来自车的第一行驶轨迹是指基于ACC跟车策略逻辑计算出的自车将要行驶的路径。
步骤106，根据自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行。
这里的相邻车道车辆的未来行驶轨迹是在步骤106之前计算得到的，具体的，根据环境感知信息中的相邻车道车辆的位置和速度信息Vp采用静态或动态预测方法计算相邻车道车辆的未来行驶轨迹。
在得到相邻车道车辆的未来行驶轨迹之后，基于自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹，根据预设步长计算自车和相邻车道车辆纵向位置的差值，统计差值低于预设距离的连续时长；根据连续时长是否超过预设时间阈值判断自车与相邻车道车辆是否长时间并行。
当连续时长超过预设时间阈值时，判断自车与相邻车道车辆发生或即将发生并行，进入车辆并行速度调节逻辑，具体执行步骤107。
当连续时长没超过预设时间阈值时，判断自车与相邻车道车辆不会发生并行，执行步骤113。
在一个具体的例子中，统计自车和相邻车道车辆纵向差值低于安全距离5米的连续时长，当连续时长超过阈值5秒时，则表示自车发生或即将发生车辆长时间并行状态，进入车辆并行速度调节逻辑，执行步骤107，否则执行步骤113。
步骤107，重新计算跟车间距，并根据相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使自车与相邻车道车辆不存在长时间并行。
当确认自车与相邻车道车辆发生或即将发生长时间并行时，在ACC车辆并行速度调节逻辑中，根据相邻车道车辆的未来行驶轨迹重新计算合适的跟车间距并规划自车未来的第一速度曲线，避开与相邻车道车辆并行的状态，直到与相邻车道车辆不存在并行风险时，执行步骤113，根据自适应巡航模式恢复跟车。
在上述步骤102之后，当自车前方不存在车辆时，则执行步骤108，进入定速巡航模式。
定速巡航模式是一种以固定的速度行驶的模式，包括CC并行状态判断逻辑、CC车辆并行速度调节逻辑和CC定速逻辑。
步骤109，在定速巡航模式下，根据环境感知信息判断相邻车道是否存在车辆。
在定速巡航模式下的判断相邻车道是否存在车辆的方法与步骤104自适应巡航模式下的判断方法相同，此处不再进行赘述。
当判断相邻车道存在车辆时，进入CC车辆并行状态判断逻辑，执行步骤110。
当判断相邻车道不存在车辆时，执行步骤114，根据定速巡航模式恢复定速巡航。即执行CC定速逻辑。
步骤110，根据自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹。
当自车与相邻车道车辆长时间并行时，在CC并行状态判断逻辑中，车载运算单元根据自车期望车速、自车实际车速Vh计算出未来自车的第二行驶轨迹，这里的未来自车的第二行驶轨迹是指基于CC并行状态判断逻辑计算出的自车将要行驶的路径。
步骤111，根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行。
相邻车道车辆的未来行驶轨迹的获取与上述步骤106的获取方法相同，此处不再进行赘述。
根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行与上述步骤106中的判断方法相同，此处不再进行赘述。
当连续时长超过预设时间阈值时，判断自车与相邻车道车辆发生或即将发生并行，进入CC车辆并行速度调节逻辑，具体执行步骤112。
当连续时长没超过预设时间阈值时，判断自车与相邻车道车辆不会发生并行，执行步骤114。
步骤112，重新计算巡航期望车速，并根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使自车与相邻车道车辆不存在长时间并行。
当自车与相邻车道车辆长时间并行时，根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线重新计算合适的巡航期望车速，并规划未来的第二速度曲线，强制加速或减速后再恢复至原来的期望车速，使自车与相邻车道车辆不存在长时间并行，避开与相邻车道车辆并行的状态，直到与相邻车道车辆不存在并行风险时，执行步骤114，根据定速巡航模式恢复定速巡航。
在对本发明实施例提供的一种车辆并行辅助驾驶方法了解的基础上，下面对本发明实施例提供的一种车辆并行辅助驾驶系统进行介绍。
图3为本发明实施例提供的一种车辆并行辅助驾驶系统的结构示意图，如图3所示，系统包括车载传感单元1、车载运算单元2和车辆控制单元3。
车载传感单元1，用于采集的自车状态信息和车辆周围的环境感知信息，并发送给车载运算单元2；自车状态信息包括自车的速度信息，环境感知信息包括自车周围车辆的状态信。
车载运算单元2，用于根据环境感知信息判断自车前方是否存在车辆；
当自车前方存在车辆时，进入自适应巡航模式；在自适应巡航模式下，根据环境感知信息判断相邻车道是否存在车辆；当相邻车道存在车辆时，根据自车期望车速、自车实际车速Vh、前车位置和前车速度Vf计算出期望跟车间距，并计算出自车到达期望跟车间距的预计时间，从而计算出未来自车的第一行驶轨迹；根据自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行；当自车与相邻车道车辆长时间并行时，重新计算跟车间距，并根据相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使自车与相邻车道车辆不存在长时间并行，将第一速度曲线发送给车辆控制单元。
当自车前方不存在车辆时，进入定速巡航模式；在定速巡航模式下，根据环境感知信息判断相邻车道是否存在车辆；当相邻车道存在车辆时，根据自车期望车速和自车实际车速Vh计算出未来自车的第二行驶轨迹；根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆是否长时间并行；当自车与相邻车道车辆长时间并行时，重新计算巡航期望车速，并根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使自车与相邻车道车辆不存在长时间并行，将第二速度曲线发送给车辆控制单元。
车辆控制单元3，用于根据第一速度曲线或第二速度曲线调节自车的速度。
优选的，车载运算单元2还用于根据相邻车道车辆的位置和速度信息Vp计算相邻车道车辆的未来行驶轨迹。
优选的，车载运算单元2具体用于基于自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹，根据预设步长计算自车和相邻车道车辆纵向位置的差值，统计差值低于预设距离的连续时长；根据连续时长是否超过预设时间阈值判断自车与相邻车道车辆是否长时间并行。
优选的，在根据自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆不存在长时间并行，或者在根据相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使自车与相邻车道车辆不存在长时间并行之后，车载运算单元2还用于根据自适应巡航模式恢复跟车。
优选的，在根据自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断自车与相邻车道车辆不存在长时间并行，或者在根据相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使所述自车与相邻车道车辆不存在长时间并行之后，所述车载运算单元2还用于根据所述定速巡航模式恢复定速巡航。
本发明实施例提供的一种车辆并行辅助驾驶系统与上述方法一一对应，此处不再进行赘述。
本发明实施例提供的一种车辆并行辅助驾驶方法和系统，首先由车载传感器获取自车状态和车辆周边的环境信息，主要包括自车速度和周边车辆的位置、速度信息；车载运算单元根据获取到的自车和环境信息，计算出车辆避开并行状态的加减速需求；最后车辆控制单元接收该加减速需求后对车辆油门和制动系统进行主动控制，调节车辆速度，从而实现并行辅助的功能，这样在遇到并行状态时能够主动调节车速，进而与相邻车道车辆在纵向上错开位置，能够避免车辆进入长时间并行状态，提高了行车安全性并且满足人类的驾驶习惯。
专业人员应该还可以进一步意识到，结合本文中所公开的实施例描述的各示例的单元及算法步骤，能够以电子硬件、计算机软件或者二者的结合来实现，为了清楚地说明硬件和软件的可互换性，在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行，取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能，但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以用硬件、处理器执行的软件模块，或者二者的结合来实施。软件模块可以置于随机存储器（RA车辆并行辅助驾驶系统）、内存、只读存储器（RO车辆并行辅助驾驶系统）、电可编程RO车辆并行辅助驾驶系统、电可擦除可编程RO车辆并行辅助驾驶系统、寄存器、硬盘、可移动磁盘、CD-RO车辆并行辅助驾驶系统、或技术领域内所公知的任意其它形式的存储介质中。
以上所述的具体实施方式，对本发明的目的、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本发明的具体实施方式而已，并不用于限定本发明的保护范围，凡在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (8)

1.一种车辆并行辅助驾驶方法，其特征在于，所述方法包括：
获取车载传感单元采集的自车状态信息和车辆周围的环境感知信息；所述自车状态信息包括自车的速度信息，所述环境感知信息包括自车周围车辆的状态信息；
根据所述环境感知信息判断自车前方是否存在车辆；
当所述自车前方存在车辆时，进入自适应巡航模式；
在所述自适应巡航模式下，根据所述环境感知信息判断相邻车道是否存在车辆；
当所述相邻车道存在车辆时，根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距，并计算出自车到达期望跟车间距的预计时间，从而计算出未来自车的第一行驶轨迹；
根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行；
当自车与相邻车道车辆长时间并行时，重新计算跟车间距，并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使所述自车与相邻车道车辆不存在长时间并行；
当所述自车前方不存在车辆时，进入定速巡航模式；
在所述定速巡航模式下，根据所述环境感知信息判断相邻车道是否存在车辆；
当所述相邻车道存在车辆时，根据所述自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹；
根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行；
当自车与相邻车道车辆长时间并行时，重新计算巡航期望车速，并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使所述自车与相邻车道车辆不存在长时间并行；
所述根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行具体包括：
基于所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹，根据预设步长计算所述自车和相邻车道车辆纵向位置的差值，统计差值低于预设距离的连续时长；
根据所述连续时长是否超过预设时间阈值判断所述自车与相邻车道车辆是否长时间并行。
2.根据权利要求1所述的车辆并行辅助驾驶方法，其特征在于，在所述根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行之前，所述方法还包括：
根据所述相邻车道车辆的位置和速度信息计算所述相邻车道车辆的未来行驶轨迹。
3.根据权利要求1所述的车辆并行辅助驾驶方法，其特征在于，在根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行，或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使所述自车与相邻车道车辆不存在长时间并行之后，所述方法还包括：
根据所述自适应巡航模式恢复跟车。
4.根据权利要求1所述的车辆并行辅助驾驶方法，其特征在于，在根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行，或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使所述自车与相邻车道车辆不存在长时间并行之后，所述方法还包括：
根据所述定速巡航模式恢复定速巡航。
5.一种基于上述权利要求1-4任一所述方法的车辆并行辅助驾驶系统，其特征在于，所述系统包括车载传感单元、车载运算单元和车辆控制单元；
所述车载传感单元，用于采集自车状态信息和车辆周围的环境感知信息，并发送给所述车载运算单元；所述自车状态信息包括自车的速度信息，所述环境感知信息包括自车周围车辆的状态信息；
所述车载运算单元，用于根据所述环境感知信息判断自车前方是否存在车辆；
当所述自车前方存在车辆时，进入自适应巡航模式；在所述自适应巡航模式下，根据所述环境感知信息判断相邻车道是否存在车辆；当所述相邻车道存在车辆时，根据自车期望车速、自车实际车速、前车位置和前车速度计算出期望跟车间距，并计算出自车到达期望跟车间距的预计时间，从而计算出未来自车的第一行驶轨迹；根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行；当自车与相邻车道车辆长时间并行时，重新计算跟车间距，并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使所述自车与相邻车道车辆不存在长时间并行，将所述第一速度曲线发送给所述车辆控制单元；
当所述自车前方不存在车辆时，进入定速巡航模式；在所述定速巡航模式下，根据所述环境感知信息判断相邻车道是否存在车辆；当所述相邻车道存在车辆时，根据所述自车期望车速和自车实际车速计算出未来自车的第二行驶轨迹；根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆是否长时间并行；当自车与相邻车道车辆长时间并行时，重新计算巡航期望车速，并根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使所述自车与相邻车道车辆不存在长时间并行，将所述第二速度曲线发送给所述车辆控制单元；
所述车辆控制单元，用于根据第一速度曲线或第二速度曲线调节所述自车的速度；
所述车载运算单元具体用于基于所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹，根据预设步长计算所述自车和相邻车道车辆纵向位置的差值，统计差值低于预设距离的连续时长；根据所述连续时长是否超过预设时间阈值判断所述自车与相邻车道车辆是否长时间并行。
6.根据权利要求5所述的车辆并行辅助驾驶系统，其特征在于，所述车载运算单元还用于根据所述相邻车道车辆的位置和速度信息计算所述相邻车道车辆的未来行驶轨迹。
7.根据权利要求5所述的车辆并行辅助驾驶系统，其特征在于，在根据所述自车的第一行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行，或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第一速度曲线，使所述自车与相邻车道车辆不存在长时间并行之后，所述车载运算单元还用于根据所述自适应巡航模式恢复跟车。
8.根据权利要求5所述的车辆并行辅助驾驶系统，其特征在于，在根据所述自车的第二行驶轨迹和相邻车道车辆的未来行驶轨迹判断所述自车与相邻车道车辆不存在长时间并行，或者在所述根据所述相邻车道车辆的未来行驶轨迹规划自车未来的第二速度曲线，使所述自车与相邻车道车辆不存在长时间并行之后，所述车载运算单元还用于根据所述定速巡航模式恢复定速巡航。
CN201910314983.9A 2019-04-18 2019-04-18 一种车辆并行辅助驾驶方法和系统 Active CN110040138B (zh)

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 CN110040138A (zh) 2019-07-23
CN110040138B true 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)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110825081B (zh) * 2019-11-08 2021-10-29 禾多科技（北京）有限公司 应用于自动驾驶高速场景的避免平行驾驶的智能决策方法
CN113220137A (zh) * 2020-02-04 2021-08-06 奥迪股份公司 移动电子设备辅助使用系统、车辆及相应的方法和介质
CN112193247A (zh) * 2020-10-19 2021-01-08 重庆长安汽车股份有限公司 一种车辆巡航速度的控制方法及控制装置
CN112530165B (zh) * 2020-11-30 2022-01-28 中国民航信息网络股份有限公司 一种基于物联网的机坪保障车辆的违章判断方法和装置
CN115547101A (zh) * 2022-08-15 2022-12-30 北京罗克维尔斯科技有限公司 一种车辆避让方法、装置、设备、介质及车辆
CN117994754A (zh) * 2022-10-31 2024-05-07 华为技术有限公司 车辆的位置获取方法、模型的训练方法以及相关设备

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5310745B2 (ja) * 2009-04-21 2013-10-09 トヨタ自動車株式会社 走行支援装置
CN104192146B (zh) * 2014-09-12 2017-03-01 辽宁工业大学 基于模糊控制的汽车智能巡航辅助驾驶系统控制方法
KR20170042961A (ko) * 2015-10-12 2017-04-20 현대자동차주식회사 주행 안전을 위한 차량 제어 장치 및 방법
JP6677822B2 (ja) * 2016-12-07 2020-04-08 本田技研工業株式会社 車両制御装置

Also Published As

Publication number Publication date
CN110040138A (zh) 2019-07-23

Similar Documents

Publication Publication Date Title
CN110040138B (zh) 一种车辆并行辅助驾驶方法和系统
CN110356394B (zh) 一种车辆主动避让障碍物的方法、装置及汽车
US10513267B2 (en) Vehicle safety system
US9744969B2 (en) Vehicle control apparatus and method for driving safety
CN110001647B (zh) 车辆触发变道方法、系统及计算机可读存储介质
US7363155B2 (en) Method and device for warning the driver of a motor vehicle
JP4873047B2 (ja) 走行制御装置
JP2009061878A (ja) 走行制御装置
KR102192959B1 (ko) 운전 지원 차량의 주행 제어 방법 및 주행 제어 장치
CN112384419B (zh) 车辆的驾驶辅助控制装置、车辆的驾驶辅助系统以及车辆的驾驶辅助控制方法
CN105339228A (zh) 静止目标识别的自适应巡航控制
CN112193246B (zh) 车辆及用于执行车辆间距离控制的方法
CN112896157A (zh) 一种防御性驾驶控制方法、装置、系统、车载终端及存储介质
CN109866748B (zh) 确定制动校正值的制动器控制系统和制动器控制方法
US20220009493A1 (en) Vehicle travel control device
US20190283772A1 (en) Driving support system and vehicle control method
US20240101154A1 (en) Method for planning an at least partly automated driving process by means of a driver assistance system
CN111376901B (zh) 车辆的控制方法、装置及车辆
CN116279341B (zh) 安全刹车方法和装置、电子设备和存储介质
JP7200786B2 (ja) 車両の制動制御装置
US20230234579A1 (en) Vehicle driving assist device
CN112712728A (zh) 用于高速公路驾驶辅助的控制单元、方法和系统
WO2020020525A1 (en) Method for performing an overtaking maneuver including considering a safety distance, analyzing component, driver assistance system, as well as vehicle
CN115195741A (zh) 车辆的控制方法、装置、车辆及存储介质
CN113830084A (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