CN103754221B - 一种车辆自适应巡航控制系统 - Google Patents
一种车辆自适应巡航控制系统 Download PDFInfo
- Publication number
- CN103754221B CN103754221B CN201410033748.1A CN201410033748A CN103754221B CN 103754221 B CN103754221 B CN 103754221B CN 201410033748 A CN201410033748 A CN 201410033748A CN 103754221 B CN103754221 B CN 103754221B
- Authority
- CN
- China
- Prior art keywords
- lane
- vehicle
- change
- car
- unit
- 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
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 49
- 230000001133 acceleration Effects 0.000 claims abstract description 38
- 238000000034 method Methods 0.000 claims abstract description 15
- 230000008569 process Effects 0.000 claims abstract description 10
- 230000006870 function Effects 0.000 claims description 34
- 230000006399 behavior Effects 0.000 claims description 11
- 238000012545 processing Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 5
- 230000010365 information processing Effects 0.000 claims description 5
- 238000005096 rolling process Methods 0.000 claims description 4
- 230000006978 adaptation Effects 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims 1
- 230000033001 locomotion Effects 0.000 abstract description 12
- 238000005457 optimization Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000004973 motor coordination Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 239000012467 final product Substances 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000002703 mutagenesis Methods 0.000 description 1
- 231100000350 mutagenesis Toxicity 0.000 description 1
- 230000002040 relaxant effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000033772 system development Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- JLYXXMFPNIAWKQ-UHFFFAOYSA-N γ Benzene hexachloride Chemical compound ClC1C(Cl)C(Cl)C(Cl)C(Cl)C1Cl JLYXXMFPNIAWKQ-UHFFFAOYSA-N 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
-
- 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
- B60W40/04—Traffic 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明涉及一种车辆自适应巡航控制系统，其特征在于：它包括信息采集单元、换道预警单元、自适应巡航控制单元和车辆动力学单元；信息采集单元采集车辆的行驶状态信息，并对行驶状态信息进行处理发送到换道预警单元和自适应巡航控制单元；换道预警单元根据接收的车辆的有效运动信息，计算自车与周边车辆之间的换道最小安全距离，根据计算结果对换道风险进行判断，并根据判断结果对车辆进行预警，并将判断结果发送到自适应巡航控制单元；自适应控制单元根据车辆运动信息以及换道风险判断结果选择控制模式，并计算车辆纵向驾驶需要的期望纵向加速度，将计算得到的期望纵向加速度发送到车辆动力学单元；车辆动力学单元将期望纵向加速度转化为期望节气门开度或制动压力，并将其发送到车辆对象，完成对车辆对象的纵向控制。
Description
技术领域
本发明涉及车辆纵向行驶安全领域，特别是关于一种具有换道辅助功能的车辆自适应巡航控制系统。
背景技术
作为驾驶辅助系统(DAS,Driver Assistance Systems)的典型代表之一，自适应巡航控制系统(ACC,Adaptive Cruise Control System)能够提升行驶安全、改善交通拥堵和缓解驾驶疲劳，已经得到研究机构和汽车企业的广泛认可与关注。迄今为止，ACC系统的发展已经比较成熟，然而，现有ACC系统在换道这一危险工况下还存在一定局限性：当驾驶员产生换道意图后，现有ACC系统未能对换道可行性进行分析；而且也未能对跟车目标的转换进行及时调整，从而对驾驶员换道行为造成阻碍；另外现有ACC系统的换道局限性增加了驾驶员对系统的手动干预频率，影响驾驶舒适性。
现有ACC系统欲对驾驶员换道行为进行纵向辅助，在换道安全方面，需要对换道可行性进行综合判断，然而现有的换道预警系统主要关注目标车道后车，没有考虑自车与周边其他车辆之间的相对运动关系，不能对换道的综合风险进行评估。另外，在换道控制方面，需要解决换道过程中自车与两辆前车之间的跟踪性、自车与周边环境多车辆之间的安全性以及驾驶员纵向感受舒适性这三个方面的多目标协调优化问题，目前还没有针对这一问题的良好解决方法。虽然也有人提出在现有ACC系统增加自动换道功能，但是其存在两方面问题：第一，ACC系统只控制车辆的纵向运动，而自动控制系统还需要对方向盘转角进行控制，二者在执行器控制方面的差异容易扰乱驾驶员的操纵感；第二，自动换道系统只控制单车辆完成换道行为，忽略了自车在换道过程中与周边车辆的运动协调关系，安全性难以保障。
发明内容
针对上述问题，本发明的目的是提供一种在换道工况下能够对周边环境风险进行判断和预警，并对驾驶员换道行为进行纵向辅助的车辆自适应巡航控制系统。
为实现上述目的，本发明采取以下技术方案：一种车辆自适应巡航控制系统，其特征在于：它包括一信息采集单元、一换道预警单元、一自适应巡航控制单元和一车辆动力学单元；所述信息采集单元用于同时采集自车与周边车辆的行驶状态信息，并对采集的自车与周边车辆的行驶状态信息进行处理获取有效运动信息，并将有效运动信息分别发送到所述换道预警单元和自适应巡航控制单元；所述换道预警单元根据接收的自车与周边环境车辆的有效运动信息，计算自车与周边车辆之间的换道最小安全距离，根据计算得到的换道最小安全距离对换道风险进行判断，并根据判断结果对车辆进行预警，并将换道风险判断结果发送到自适应巡航控制单元；所述自适应控制单元根据自车与周围车辆信息的有效运动信息以及换道风险判断结果选择控制模式，并根据所选择的控制模式计算车辆纵向驾驶需要的期望纵向加速度，将计算得到的期望纵向加速度发送到所述车辆动力学单元；所述车辆动力学单元将期望纵向加速度转化为期望节气门开度或期望制动压力，并将期望节气门开度或期望制动压力发送到车辆对象，完成对车辆对象的纵向控制。
所述信息采集单元包括一自车信息采集模块、一信息处理模块和一无线通讯设备；所述自车信息采集模块用于采集自车的行驶状态信息，并将采集的自车行驶状态信息发送到所述信息处理模块；所述无线通讯设备用于获取自车附近周边其他车辆的行驶状态信息，并将获取的附近其他车辆的行驶状态信息发送到所述信息处理模块；所述信息处理模块根据附近周边车辆与自车的纵横向位置的相关信息，筛选出原始车道前车、原始车道后车、目标车道前车和目标车道后车这四辆周边车辆，并提取各车辆的纵向位置、纵向速度、纵向加速度和横向位置。
所述换道预警单元包括一换道最小安全距离计算模块、一预警决策模块和一预警执行模块；所述换道最小安全距离计算模块根据方向盘转角信号得知驾驶员产生换道意图后，根据接收的自车和周边环境车辆的有效运动信息，从跟车与避撞的角度出发分别计算自车与周边环境车辆之间的换道最小安全距离，并将计算得到的换道最小安全距离发送到所述预警决策模块；所述预警决策模块将自车与周边环境车辆的实际车间距离与预设的换道最小安全距离值进行对比，当任一实际车间距离小于相应换道最小安全距离值，认为换道存在风险，所述预警决策模块将判断结果发送到预警执行模块和自适应巡航控制单元，当换道存在风险时，所述预警执行模块开始报警，此时所述自适应巡航控制单元不对换道行为进行辅助，预警过程中，若驾驶员及时取消换道，预警解除；当换道没有风险时，所述预警执行模块不报警，所述自适应巡航控制单元对换道行为进行辅助。
所述自适应巡航控制单元包括一换道意图识别模块和一巡航模式选择模块，所述巡航模式选择模块中包括巡航模式、常规ACC模式和LCACC模式三种控制模式；所述换道意图识别模块判断得知驾驶员没有换道意图时，若原始车道前方车辆与自车的车间状态位于常规ACC模式工作范围以内，则进入常规ACC模式，否则进入巡航模式；当所述换道意图识别模块得知驾驶员具有换道意图时，且根据所述换道预警单元输出的换道风险判断结果判断得知换道存在风险，所述换道预警单元对驾驶员进行报警，则所述自适应巡航控制单元维持原巡航模式，继续维持与原始车道前车的跟车行驶；当所述换道意图识别模块得知驾驶员具有换道意图时，且根据所述换道预警单元输出的换道风险判断结果判断得知换道没有风险，所述进入LCACC模式，换道结束后切出该模式；换道开始后，LCACC包括前车跟踪模式和巡航模式，当自车与目标车道前车的车间状态位于ACC工作范围以内时，进入两前车跟踪模式；当该车间状态位于ACC工作范围以外时，目标车道具有足够换道空间，进入巡航模式。
进入LCACC模式的车辆多目标协调换道辅助自适应巡航控制方法过程为：1）根据两前车跟踪性、多车运动安全性和纵向驾驶舒适性的需求目标，设定LCACC的综合性能指标，其中，LCACC的综合性能指标包括代价函数和I/O约束；①LCACC代价函数的设定：a）利用自车与两辆前车的车距误差和车速误差的二范数线性组合建立跟踪性代价函数；b）利用约束纵向加速度建立舒适性代价函数；②LCACC I/O约束的设定：a）在跟踪性能方面，利用驾驶员实验数据统计得到用于限制车速误差和车距误差的驾驶员容许的跟车误差约束；b）在安全性能方面，从跟车和避撞的角度出发，约束自车与周边多车辆之间的安全距离；c）在舒适性能方面，约束期望纵向加速度的取值范围；2）建立多目标协调优化控制问题，采用滚动时域优化算法求解多目标协调优化控制问题，得到最优控制量，实现优化控制。
本发明由于采取以上技术方案，其具有以下优点：1、本发明设置有具有换道辅助功能的自适应巡航控制单元，自适应巡航控制单元能够结合自车信息、周边多车辆信息以及换道预警信息，在CC模式、常规ACC模式和LCACC模式之间平滑切换，使得车辆纵向控制更加符合驾驶员期望，自车在换道过程中能够与周边车辆的运动协调，因此能够解决了常规ACC对换道的阻碍问题，对车辆纵向行为进行多目标协调控制，能够及时对换道的综合风险进行评估，从而改善常规ACC在换道工况下的功能局限，提高系统的可接受度，有效保证车辆换道安全，避免事故发生。2、本发明设置有换道预警单元，换道预警单元根据接收的自车与周边环境车辆的有效运动信息，计算自车与周边车辆之间的换道最小安全距离，根据计算得到的换道最小安全距离对换道风险进行判断，并根据判断结果对车辆进行预警，因此本发明的换道预警单元综合考虑自车与周边多车辆之间的换道安全距离，能够对换道风险进行全面判断和预警，提醒驾驶员换道存在的风险。3、本发明进入LCACC模式的车辆多目标协调换道辅助自适应巡航控制首先根据两前车跟踪性、多车运动安全性和纵向驾驶舒适性的需求目标，设定LCACC的综合性能指标，并建立多目标协调优化控制问题，采用滚动时域优化算法求解多目标协调优化控制问题，得到最优控制量，实现自车优化控制，因此本发明通过建立多目标优化问题，很好解决了换道过程中两前车跟踪性、多车运动安全性和纵向驾驶舒适性三者之间的综合优化协调，有效保障自车换道安全，防止追尾事故的发生；LCACC代价函数的设定首先利用自车与两辆前车的车距误差和车速误差的二范数线性组合建立跟踪性代价函数；然后利用约束纵向加速度建立舒适性代价函数，跟踪性代价函数用于实现换道过程中自车与原始车道前车、目标车道前车这两辆车之间的协调跟踪问题，通过提前优化期望纵向加速度，降低了换道后的跟车调整时间，通过设计双目标的连续切换方法，避免常规ACC中跟车目标突变引起的期望加速度突变；LCACCI/O约束的设定首先在跟踪性能方面，利用驾驶员实验数据统计得到用于限制车速误差和车距误差的驾驶员容许的跟车误差约束；其次在安全性能方面，从跟车和避撞的角度出发，约束自车与周边多车辆之间的安全距离；另外在舒适性能方面，约束期望纵向加速度的取值范围；因此跟踪性I/O约束保证了车距误差和车速误差在驾驶员期望误差范围以内，符合驾驶员跟车期望；安全性I/O约束，使得自车与周边多车辆之间的车距尽量保持在安全跟车范围以内，提升了驾驶安全性；舒适性I/O约束，通过约束期望纵向加速度的变化量和取值范围，保证加速和制动强度，使得自车纵向运动过程符合驾驶员纵向舒适性要求。本发明可以广泛应用于车辆的换道过程中。
附图说明
图1是本发明LCACC系统的结构示意图；
图2是本发明LCACC系统中信息采集单元的结构示意图；
图3是本发明LCACC系统中换道预警单元的工作流程示意图；
图4是本发明LCACC系统中自适应巡航控制单元的工作流程示意图；
图5是本发明LCACC系统中LCACC控制器的控制原理示意图。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
如图1所示，本发明在现有车辆的驾驶控制系统中设置一换道辅助自适应巡航控制系统（LCACC,Adaptive Cruise Control with Lane Change Assist），它包括一信息采集单元1、一换道预警单元2、一自适应巡航控制单元3和一车辆动力学单元4；信息采集单元1用于同时采集自车与周边环境车辆的行驶状态信息，并对采集的自车与周边环境车辆的行驶状态信息进行处理获取有效运动信息，并将有效运动信息分别发送到换道预警单元2和自适应巡航控制单元3；换道预警单元2根据接收的自车与周边环境车辆的有效运动信息，计算自车与周边环境车辆之间的换道最小安全距离，根据计算得到的换道最小安全距离对换道风险进行判断，并根据判断结果对车辆进行预警，并将换道风险判断结果发送到自适应巡航控制单元3；自适应控制单元3根据自车与周围环境车辆信息的有效运动信息以及换道风险判断结果选择控制模式，并根据所选择的控制模式计算车辆纵向驾驶需要的期望纵向加速度，将计算得到的期望纵向加速度发送到车辆动力学单元4；车辆动力学单元4将期望纵向加速度转化为期望节气门开度或期望制动压力，并将期望节气门开度或期望制动压力发送到车辆对象，完成对车辆对象的纵向控制。
上述实施例中，如图1、图2所示，信息采集单元1包括一自车信息采集模块11、一信息处理模块12和一无线通讯设备13。自车信息采集模块11用于采集自车的行驶状态信息，即包括自车的纵向位置、纵向速度、节气门开度、制动主缸压力、方向盘转角和横向位置，并将采集的自车行驶状态信息发送到信息处理模块12；无线通讯设备13用于获取自车附近周边其他车辆的行驶状态信息，即包括周边其他车辆的纵向位置、纵向速度、纵向加速度和横向位置，并将获取的附近其他车辆的行驶状态信息发送到信息处理模块12，其中，自车周边附近车辆包括四辆车，分别为自车所在车道的前方车辆信息（原始车道前车）、自车所在车道的后方车辆信息（原始车道后车）、自车换道目标车道的前方车辆信息（目标车道前车）、自车换道目标车道的后方车辆信息（目标车道车）；信息处理模块12根据附近周边车辆与自车的纵横向位置的相关信息，筛选出原始车道前车、原始车道后车、目标车道前车和目标车道后车这四辆周边车辆，并提取各车辆的纵向位置、纵向速度、纵向加速度和横向位置等。无线通讯设备13可以采用DSRC(Dedicated Short Range Communication)通讯设备。
上述各实施例中，如图1、图3所示，换道预警单元2包括一换道最小安全距离计算模块21、一预警决策模块22和一预警执行模块23。换道最小安全距离计算模块21根据方向盘转角信号得知驾驶员产生换道意图后，根据接收的自车和周边环境车辆的有效运动信息，从跟车与避撞的角度出发分别计算自车与周边环境车辆（原始车道前车、原始车道后车、目标车道前车和目标车道后车）之间的换道最小安全距离，并将计算得到的换道最小安全距离发送到预警决策模块22。预警决策模块22将自车与周边环境车辆的实际车间距离与预设的换道最小安全距离值进行对比，当任一实际车间距离小于相应换道最小安全距离值，认为换道存在风险，预警决策模块22将判断结果发送到预警执行模块23和自适应巡航控制单元3。当换道存在风险时，预警执行模块23开始报警，此时自适应巡航控制单元3不对换道行为进行辅助，预警过程中，若驾驶员及时取消换道，预警解除。当换道没有风险时，预警执行模块23不报警，自适应巡航控制单元3对换道行为进行辅助。
上述各实施例中，如图1、图4所示，自适应巡航控制单元3根据自车与周边环境车辆的有效运动信息以及换道风险判断结果对具体巡航模式进行判断，自适应巡航控制单元3包括一换道意图识别模块31和一巡航模式选择模块32，其中巡航模式选择模块中包括巡航模式（CC模式）、常规ACC模式和LCACC模式三种控制模式。
当换道意图识别模块31根据方向盘转角判断得知驾驶员没有换道意图时，若原始车道前方车辆与自车的车间状态位于常规ACC模式工作范围以内，则进入常规ACC模式，否则进入巡航模式；
当换道意图识别模块31根据方向盘转角判断得知驾驶员具有换道意图时，且根据换道预警单元2输出的换道风险判断结果判断得知换道存在风险，换道预警单元2对驾驶员进行报警，则自适应巡航控制单元3维持原巡航模式，继续维持与原始车道前车的跟车行驶，原巡航模式在一定程度上对驾驶员换道纵向速度造成阻碍，降低驾驶员换道意图，从而实现安全辅助；
当换道意图识别模块31根据方向盘转角，判断得知驾驶员具有换道意图时，且根据换道预警单元2输出的换道风险判断结果判断得知换道没有风险，则自适应巡航控制单元进入LCACC模式，换道结束后切出该模式；换道之前和换道之后，在单车道跟车行驶工况下，当车间状态位于ACC工作范围以内时，系统进入常规ACC模式，否则为巡航模式。以上三种模式中，其中巡航模式和常规ACC模式的控制过程为现有技术，不再进行赘述，本发明主要针对LCACC控制过程进行详细说明。
如图5所示，进入LCACC模式的前提是换道之前车辆处于ACC模式，即自车与自车车道前车的车间状态处于ACC工作范围以内，换道开始后，LCACC包括两种两前车跟踪模式和巡航模式两种控制模式，当自车与目标车道前车的车间状态位于ACC工作范围以内时，进入两前车跟踪模式；当该车间状态位于ACC工作范围以外时，目标车道具有足够换道空间，进入巡航模式。
当进入两前车跟踪模式中，需要协调自车与两辆前车的跟踪性，兼顾自车与周边环境车辆的车间运动安全性，考虑驾驶员纵向舒适性感受，实现换道辅助过程中跟踪性、安全性和舒适性的整体优化，本发明的车辆多目标协调换道辅助自适应巡航控制方法以模型预测控制(MPC,Model Predictive Control)理论为基础的，包括以下步骤：
1、控制对象建模，在LCACC系统中，控制对象建模主要涉及三个方面：自车动力学模型、旁车动力学模型以及驾驶员期望跟车模型。
1）根据车辆对象的纵向动力学和运动学分析建立自车动力学模型
建立自车动力学模型以一阶惯性迟滞传递函数描述实际纵向加速度与期望纵向加速度之间的数学关系：
式中，ax为实际纵向加速度，Kg为函数增益，Tgs为时间常数。
结合自车的纵向运动学特性，建立自车的纵向动力学模型为：
式中，xh=[sh vh ah]T表示状态变量，sh、vh和ah分别表示自车纵向位置、纵向速度和纵向加速度，u=axdes为输入量，Acont和Bcont分别为状态变量和输入量的系数矩阵。
2）旁车动力学模型的建立中，为简化起见，假设其在预测时域内以当前纵向加速度保持匀加速行驶，通过运动学求解其纵向运动状态。
3）驾驶员期望跟车模型的建立时选择线性跟车模型：
ddes＝τ·vh+dsafe (3)
式中，ddes表示驾驶员期望跟车距离，τ表示期望跟车时距，dsafe表示安全停车距离。
2、根据车辆多目标协调换道辅助自适应巡航控制的两前车跟踪性、多车运动安全性和纵向驾驶舒适性的需求目标，设定LCACC的综合性能指标，其中，LCACC的综合性能指标包括代价函数和I/O约束；
1）LCACC的代价函数设定包括以下内容：
①利用自车与两辆前车的车距误差和车速误差的二范数线性组合建立跟踪性代价函数，保证跟车误差收敛以及跟车目标连续切换，其中，两辆前车分别是指自车所在车道的前方车辆和自车换道目标车道的前方车辆。
本发明的跟踪性代价函数以自车与两辆前车的车距误差和车速误差的二范数线性组合为评价标准，建立其离散型二次型跟踪性代价函数为：
Ltralo(k+i+1|k)＝wΔdΔdloh(k+i+1|k)2+wΔvΔvloh(k+i+1|k)2 (4)
Ltrald(k+i+1|k)＝wΔdΔdldh(k+i+1|k)2+wΔvΔvldh(k+i+1|k)2
式中，k表示当前时刻，(k+i+1|k)表示利用k时刻信息对k+i+1状态进行预测，P表示预测时域，Ltra表示跟踪性代价函数，Ltralo表示基于原始车道前车的跟踪性代价函数，Ltrald表示基于目标车道前车的跟踪性代价函数，λlo表示基于原始车道前车的跟车权重系数，λld表示基于目标车道前车的跟车权重系数，Δdloh表示基于原始车道前车的车距误差，Δdldh表示基于目标车道前车的车距误差，Δvloh表示基于原始车道前车的车速误差，Δvldh表示基于目标车道前车的车速误差，wΔd为Δd的权重系数，wΔv为Δv的权重系数。
②利用约束纵向加速度建立舒适性代价函数，使得自车纵向运动符合驾驶员舒适性要求；
本发明的舒适性能指标以约束纵向加速度来体现，建立其离散型二次型舒适性代价函数为：
式中，Lcom表示舒适性代价函数，axdes表示期望纵向加速度，wu为axdes的权重系数。
2）LCACC的I/O约束设定包括以下内容：
①在跟踪性能方面，利用驾驶员容许的跟踪性能指标限制车速误差和车距误差范围，避免过大车距引起旁车切入，或者过小车距引起车间追尾；本发明利用驾驶员实验数据统计得到用于限制车速误差和车距误差的驾驶员容许的跟车误差约束，其数学表达形式为：
Δdmin≤Δdloh(k+i|k)≤Δdmax
Δdmin≤Δdldh(k+i|k)≤Δdmax (6)
Δvmin≤Δvloh(k+i|k)≤Δvmax
Δvmin≤Δvldh(k+i|k)≤Δvmax
式中，k+i|k表示利用k时刻信息对k+i状态进行预测，dmin表示车距误差的最小值，dmax表示车距误差的最大值，vmin表示车速误差的最小值，vmax表示车速误差的最大值，可以由驾驶员跟车过程的试验数据辨识得到。
②在安全性能方面，通过约束自车与周边多车辆之间的安全跟车距离，保证跟车安全；自车周边多车辆主要是指自车所在车道的前方车辆信息（原始车道前车）、自车所在车道的后方车辆信息（原始车道后车）、自车换道目标车道的前方车辆信息（目标车道前车）、自车换道目标车道的后方车辆信息（目标车道车）。
本发明从跟车和避撞的角度出发，约束自车与周边多车辆之间的安全距离，其数学表达形式为：
dsloh(k+i+1|k)≥max(τTHWlovh(k+i+1|k),τTTClo(vh(k+i+1|k)-vlo(k+i+1|k)))
dsldh(k+i+1|k)≥max(τTHWldvh(k+i+1|k),τTTCld(vh(k+i+1k)-vld(k+i+1|k))) (7)
dsroh(k+i+1|k)≥max(τTHWrovro(k+i+1|k),τTTCro(vro(k+i+1|k)-vh(k+i+1|k)))
dsrdh(k+i+1|k)≥max(τTHWrdvrd(k+i+1|k),τTTCrd(vrd(k+i+1|k)-vh(k+i+1|k)))
式中，dsloh、dsldh、dsroh和dsrdh分别为自车与各车辆的安全跟车距离，τTHWlo、τTHWld、τTHWro和τTHWrd分别为基于各车辆的安全跟车时距，τTTClo、τTTCld、τTTCro和τTTCrd分别为基于各车辆的安全避撞时间，vh、vlo、vld、vro和vrd分别为各车辆速度。
③在舒适性能方面，通过约束期望纵向加速度的取值范围，保证纵向乘坐舒适性，其数学表达形式为：
umin≤u(k+i+1|k)≤umax (8)
式中，u表示自车的纵向加速度，umin表示加速度最小值。umax表示加速度最大值。
3、建立多目标协调优化控制问题，采用滚动时域优化算法求解多目标协调优化控制问题，得到最优控制量实现优化控制，具体包括以下步骤：
1）通过现有有关设备获得自车和周边多车辆的运动状态信息，并将其发送到自车控制器；自车运动状态信息包括自车的纵向位置、纵向速度、节气门开度、制动主缸压力、方向盘转角和横向位置，自车运动状态信息包括周边多车辆的纵向位置、纵向速度、纵向加速度和横向位置；
2）利用线性加权和法将跟踪性代价函数和舒适性代价函数转化为整体代价函数；
Lindex＝Ltra+Lcom (9)
式中，Lindex为整体代价函数。
3）将所有I/O约束转化为与系统预测时域输入向量相关的约束条件；
AUU≤bU (10)
式中，AU为约束不等式的系数矩阵，U为系统预测时域输入向量，bU为约束不等式的常数项矩阵。
4）结合代价函数和I/O约束的数学形式，建立多目标协调优化控制问题：
minLindex
Subj.to: (11)
AUU≤bU
5）采用约束管理法软化硬约束，选择Dantizig-wolfe有效集法，求解多目标协调优化控制问题，得到最优控制量为：
U＝argminLindex
Subj.to: (12)
AUU≤bU
6）提取最优控制量的首个元素U（0），即得到期望纵向加速度。
上述各实施例中，如图1所示，车辆动力学单元4包括一车辆逆纵向动力学模块41和一车辆对象42，车辆逆纵向动力学模块41根据接收的自适应巡航控制单元3输出的最优控制量，即期望纵向加速度，得到输出期望节气门开度和期望制动压力，并将其发送到车辆对象42，从而实现控制器对车辆纵向运动的控制。
上述各实施例仅用于说明本发明，其中各部件的结构和连接方式等都是可以有所变化的，凡是在本发明技术方案的基础上进行的等同变换和改进，均不应排除在本发明的保护范围之外。
Claims (4)
1.一种车辆自适应巡航控制系统，其特征在于：它包括一信息采集单元、一换道预警单元、一自适应巡航控制单元和一车辆动力学单元；所述信息采集单元用于同时采集自车与周边车辆的行驶状态信息，并对采集的自车与周边车辆的行驶状态信息进行处理获取有效运动信息，并将有效运动信息分别发送到所述换道预警单元和自适应巡航控制单元；所述换道预警单元根据接收的自车与周边环境车辆的有效运动信息，计算自车与周边车辆之间的换道最小安全距离，根据计算得到的换道最小安全距离对换道风险进行判断，并根据判断结果对车辆进行预警，并将换道风险判断结果发送到自适应巡航控制单元；所述自适应巡航控制单元根据自车与周围车辆信息的有效运动信息以及换道风险判断结果选择控制模式，并根据所选择的控制模式计算车辆纵向驾驶需要的期望纵向加速度，将计算得到的期望纵向加速度发送到所述车辆动力学单元；所述车辆动力学单元将期望纵向加速度转化为期望节气门开度或期望制动压力，并将期望节气门开度或期望制动压力发送到车辆对象，完成对车辆对象的纵向控制；
所述自适应巡航控制单元包括一换道意图识别模块和一巡航模式选择模块，所述巡航模式选择模块中包括巡航模式、常规ACC模式和LCACC模式三种控制模式；所述换道意图识别模块判断得知驾驶员没有换道意图时，若原始车道前方车辆与自车的车间状态位于常规ACC模式工作范围以内，则进入常规ACC模式，否则进入巡航模式；当所述换道意图识别模块得知驾驶员具有换道意图时，且根据所述换道预警单元输出的换道风险判断结果判断得知换道存在风险，所述换道预警单元对驾驶员进行报警，则所述自适应巡航控制单元维持原巡航模式，继续维持与原始车道前车的跟车行驶；当所述换道意图识别模块得知驾驶员具有换道意图时，且根据所述换道预警单元输出的换道风险判断结果判断得知换道没有风险，进入LCACC模式，换道结束后切出该模式；换道开始后，LCACC包括前车跟踪模式和巡航模式，当自车与目标车道前车的车间状态位于ACC工作范围以内时，进入两前车跟踪模式；当该车间状态位于ACC工作范围以外时，目标车道具有足够换道空间，进入巡航模式。
2.如权利要求1所述的一种车辆自适应巡航控制系统，其特征在于：所述信息采集单元包括一自车信息采集模块、一信息处理模块和一无线通讯设备；所述自车信息采集模块用于采集自车的行驶状态信息，并将采集的自车行驶状态信息发送到所述信息处理模块；所述无线通讯设备用于获取自车附近周边其他车辆的行驶状态信息，并将获取的附近其他车辆的行驶状态信息发送到所述信息处理模块；所述信息处理模块根据附近周边车辆与自车的纵横向位置的相关信息，筛选出原始车道前车、原始车道后车、目标车道前车和目标车道后车这四辆周边车辆，并提取各车辆的纵向位置、纵向速度、纵向加速度和横向位置。
3.如权利要求1～2任一项所述的一种车辆自适应巡航控制系统，其特征在于：所述换道预警单元包括一换道最小安全距离计算模块、一预警决策模块和一预警执行模块；所述换道最小安全距离计算模块根据方向盘转角信号得知驾驶员产生换道意图后，根据接收的自车和周边环境车辆的有效运动信息，从跟车与避撞的角度出发分别计算自车与周边环境车辆之间的换道最小安全距离，并将计算得到的换道最小安全距离发送到所述预警决策模块；所述预警决策模块将自车与周边环境车辆的实际车间距离与预设的换道最小安全距离值进行对比，当任一实际车间距离小于相应换道最小安全距离值，认为换道存在风险，所述预警决策模块将判断结果发送到预警执行模块和自适应巡航控制单元，当换道存在风险时，所述预警执行模块开始报警，此时所述自适应巡航控制单元不对换道行为进行辅助，预警过程中，若驾驶员及时取消换道，预警解除；当换道没有风险时，所述预警执行模块不报警，所述自适应巡航控制单元对换道行为进行辅助。
4.如权利要求1～2任一项所述的一种车辆自适应巡航控制系统，其特征在于：进入LCACC模式的车辆多目标协调换道辅助自适应巡航控制方法过程为：
1)根据两前车跟踪性、多车运动安全性和纵向驾驶舒适性的需求目标，设定LCACC的综合性能指标，其中，LCACC的综合性能指标包括代价函数和I/O约束；
①LCACC代价函数的设定：a)利用自车与两辆前车的车距误差和车速误差的二范数线性组合建立跟踪性代价函数；b)利用约束纵向加速度建立舒适性代价函数；
②LCACC I/O约束的设定：a)在跟踪性能方面，利用驾驶员实验数据统计得到用于限制车速误差和车距误差的驾驶员容许的跟车误差约束；b)在安全性能方面，从跟车和避撞的角度出发，约束自车与周边多车辆之间的安全距离；c)在舒适性能方面，约束期望纵向加速度的取值范围；
2)建立多目标协调优化控制问题，采用滚动时域优化算法求解多目标协调优化控制问题，得到最优控制量，实现优化控制。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410033748.1A CN103754221B (zh) | 2014-01-24 | 2014-01-24 | 一种车辆自适应巡航控制系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410033748.1A CN103754221B (zh) | 2014-01-24 | 2014-01-24 | 一种车辆自适应巡航控制系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN103754221A CN103754221A (zh) | 2014-04-30 |
| CN103754221B true CN103754221B (zh) | 2017-05-24 |
Family
ID=50521601
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410033748.1A Active CN103754221B (zh) | 2014-01-24 | 2014-01-24 | 一种车辆自适应巡航控制系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN103754221B (zh) |
Families Citing this family (44)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103963785A (zh) * | 2014-05-20 | 2014-08-06 | 武汉理工大学 | 一种用于汽车自适应巡航系统的双模式控制方法 |
| JP5952862B2 (ja) * | 2014-06-27 | 2016-07-13 | 富士重工業株式会社 | 車両の運転支援装置 |
| KR102005253B1 (ko) * | 2014-11-18 | 2019-07-31 | 로베르트 보쉬 게엠베하 | 극도로 빠르게 접근하는 차량들에 응답하는 차선 보조 시스템 |
| JP6430799B2 (ja) * | 2014-11-28 | 2018-11-28 | 株式会社デンソー | 車両の走行制御装置 |
| CN104742903B (zh) * | 2015-03-13 | 2019-03-08 | 小米科技有限责任公司 | 实现定速巡航的方法及装置 |
| CN105035090B (zh) * | 2015-06-06 | 2017-10-13 | 吉林大学 | 基于交通信号灯的自主驾驶车辆轨迹预测控制方法 |
| CN104925057A (zh) * | 2015-06-26 | 2015-09-23 | 武汉理工大学 | 一种具有多模式切换体系的汽车自适应巡航系统及其控制方法 |
| US11458970B2 (en) | 2015-06-29 | 2022-10-04 | Hyundai Motor Company | Cooperative adaptive cruise control system based on driving pattern of target vehicle |
| KR102107774B1 (ko) * | 2016-12-30 | 2020-05-07 | 현대자동차주식회사 | 목표차량의 운전패턴에 따른 협조 적응 순항 제어 시스템 |
| KR102107726B1 (ko) * | 2016-12-30 | 2020-05-07 | 현대자동차주식회사 | 협조 적응형 순항 제어 시스템의 속도 제어 장치 및 방법 |
| CN105313891B (zh) * | 2015-10-22 | 2017-08-11 | 清华大学 | 一种多车协同避撞方法及装置 |
| US9791864B2 (en) * | 2016-03-10 | 2017-10-17 | Ford Global Technologies, Llc | Systems and methods for driving risk index estimation |
| EP3254919B1 (en) * | 2016-06-07 | 2021-10-06 | Volvo Car Corporation | Adaptive cruise control system and vehicle comprising an adaptive cruise control system |
| US10435023B2 (en) * | 2016-12-19 | 2019-10-08 | Continental Automotive Systems, Inc. | Predictive powertrain limits strategy for autonomous/automated driving vehicle |
| CN108528432B (zh) * | 2017-03-02 | 2020-11-06 | 比亚迪股份有限公司 | 车辆行驶自动控制方法和装置 |
| CN107300863B (zh) * | 2017-07-12 | 2020-01-10 | 吉林大学 | 一种基于map图和在线标定的纵向加速度控制方法 |
| TWI639525B (zh) * | 2017-11-20 | 2018-11-01 | 財團法人車輛研究測試中心 | Adaptive vehicle speed control method and adaptive vehicle speed control device |
| CN108357493A (zh) * | 2018-02-27 | 2018-08-03 | 牟特科技（北京）有限公司 | 一种车辆智能巡航的方法及装置 |
| CN108657066B (zh) * | 2018-05-09 | 2023-05-02 | 株式会社电装 | 加塞预警系统及加塞预警方法 |
| CN108919798B (zh) * | 2018-06-10 | 2020-08-11 | 同济大学 | 一种基于混合函数域的网联智能车辆编队行驶控制方法 |
| CN109131326B (zh) * | 2018-08-08 | 2020-04-14 | 大连理工大学 | 一种具有换道辅助功能的自适应巡航控制器及其工作方法 |
| CN108961839A (zh) * | 2018-09-05 | 2018-12-07 | 奇瑞汽车股份有限公司 | 行车变道方法及装置 |
| CN111196275A (zh) * | 2018-11-16 | 2020-05-26 | 中科院微电子研究所昆山分所 | 一种多目标自适应巡航控制方法、装置及设备 |
| CN109725639B (zh) * | 2018-12-13 | 2021-12-07 | 北京工业大学 | 巡航系统的线性控制方法及装置 |
| CN109407673A (zh) * | 2018-12-19 | 2019-03-01 | 清华大学苏州汽车研究院（吴江） | 一种适用于结构化道路的自主换道控制方法及系统 |
| CN110614994B (zh) * | 2018-12-29 | 2021-01-22 | 长城汽车股份有限公司 | 车辆自动驾驶时换道的控制方法、控制系统及车辆 |
| CN111830951B (zh) * | 2019-03-29 | 2022-10-14 | 昆山微电子技术研究院 | 一种自适应跟随预测控制方法、系统及装置 |
| CN111830950B (zh) * | 2019-03-29 | 2022-10-14 | 昆山微电子技术研究院 | 一种自适应跟随预测控制方法、系统及装置 |
| CN110705388B (zh) * | 2019-09-16 | 2022-04-01 | 清华大学 | 一种基于预测反馈的辅助驾驶用目标车辆换道识别方法 |
| CN110941275A (zh) * | 2019-12-06 | 2020-03-31 | 格物汽车科技(苏州)有限公司 | 用于车辆自动驾驶的数据处理方法 |
| CN111260956B (zh) * | 2020-01-15 | 2021-03-16 | 清华大学 | 一种基于模型预测控制的车辆自动换道规划与控制方法 |
| CN111137288B (zh) * | 2020-01-19 | 2021-07-20 | 江苏大学 | 一种网联条件下多车协同换道方法 |
| CN111402627B (zh) * | 2020-02-24 | 2021-06-25 | 吉林大学 | 一种基于车联网的多工况换道安全预警系统及预警方法 |
| CN114084136B (zh) * | 2020-08-05 | 2024-01-30 | 上海汽车集团股份有限公司 | 车辆变道过程中的纵向控制跟车目标选择方法及装置 |
| CN112519774B (zh) * | 2020-11-20 | 2022-05-24 | 雄狮汽车科技(南京)有限公司 | 自适应巡航控制方法和系统 |
| CN112758091B (zh) * | 2021-01-25 | 2022-12-02 | 上汽通用五菱汽车股份有限公司 | 自适应巡航控制方法、系统、装置及存储介质 |
| CN112937607B (zh) * | 2021-03-29 | 2021-09-17 | 紫清智行科技(北京)有限公司 | 一种用于景区观光车的网联自动驾驶系统及方法 |
| CN113500993B (zh) * | 2021-06-21 | 2022-09-20 | 上汽通用五菱汽车股份有限公司 | 防碰撞功能参数的标定方法、车辆及可读存储介质 |
| CN113428170B (zh) * | 2021-07-31 | 2022-05-17 | 重庆长安汽车股份有限公司 | 一种自动驾驶制动不足的预警方法 |
| CN113635900B (zh) * | 2021-08-10 | 2024-03-19 | 吉林大学 | 一种预测巡航过程中基于能量管理的换道决策控制方法 |
| CN113515038B (zh) * | 2021-09-07 | 2021-11-26 | 西南交通大学 | 一种车辆换道方法、装置、设备及可读存储介质 |
| CN113665574B (zh) * | 2021-10-22 | 2022-01-11 | 清华大学 | 智能汽车换道时长预测及拟人化轨迹规划方法 |
| CN114212083B (zh) * | 2022-01-18 | 2024-02-27 | 浙江工业大学 | 一种在线优化调度的网联车辆多目标自适应巡航控制方法 |
| CN115063967B (zh) * | 2022-05-31 | 2024-01-26 | 河南越秀尉许高速公路有限公司 | 一种对跟车行驶下的acc车辆的预警系统及其预警方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101396968A (zh) * | 2007-09-27 | 2009-04-01 | 株式会社日立制作所 | 行车支援装置 |
| CN101837781A (zh) * | 2009-03-06 | 2010-09-22 | 通用汽车环球科技运作公司 | 用于自动车道对正或换道的控制系统的基于模型的预测控制 |
| CN103003118A (zh) * | 2010-07-16 | 2013-03-27 | 斯堪尼亚商用车有限公司 | 代价函数创建 |
| US8428843B2 (en) * | 2008-06-20 | 2013-04-23 | GM Global Technology Operations LLC | Method to adaptively control vehicle operation using an autonomic vehicle control system |
| CN103065501A (zh) * | 2012-12-14 | 2013-04-24 | 清华大学 | 一种汽车换道预警方法及换道预警系统 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103069466B (zh) * | 2010-06-18 | 2015-07-15 | 本田技研工业株式会社 | 用于预测驾驶员的变线意图的系统 |
-
2014
- 2014-01-24 CN CN201410033748.1A patent/CN103754221B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101396968A (zh) * | 2007-09-27 | 2009-04-01 | 株式会社日立制作所 | 行车支援装置 |
| US8428843B2 (en) * | 2008-06-20 | 2013-04-23 | GM Global Technology Operations LLC | Method to adaptively control vehicle operation using an autonomic vehicle control system |
| CN101837781A (zh) * | 2009-03-06 | 2010-09-22 | 通用汽车环球科技运作公司 | 用于自动车道对正或换道的控制系统的基于模型的预测控制 |
| CN103003118A (zh) * | 2010-07-16 | 2013-03-27 | 斯堪尼亚商用车有限公司 | 代价函数创建 |
| CN103065501A (zh) * | 2012-12-14 | 2013-04-24 | 清华大学 | 一种汽车换道预警方法及换道预警系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN103754221A (zh) | 2014-04-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103754221B (zh) | 一种车辆自适应巡航控制系统 | |
| CN109855639B (zh) | 基于障碍物预测与mpc算法的无人驾驶轨迹规划方法 | |
| CN105313891B (zh) | 一种多车协同避撞方法及装置 | |
| CN109035862B (zh) | 一种基于车车通信的多车协同换道控制方法 | |
| CN111750887B (zh) | 降低事故严重程度的无人驾驶车辆轨迹规划方法及系统 | |
| CN109131326B (zh) | 一种具有换道辅助功能的自适应巡航控制器及其工作方法 | |
| CN108860148B (zh) | 基于驾驶员跟车特性安全距离模型的自适应巡航控制方法 | |
| CN110155046A (zh) | 自动紧急制动分级控制方法与系统 | |
| CN109131312B (zh) | 一种智能电动汽车acc/esc集成控制系统及其方法 | |
| CN110103956A (zh) | 一种无人车自动超车轨迹规划方法 | |
| CN113044012B (zh) | 半挂汽车列车的制动控制方法、装置、设备及存储介质 | |
| CN107346612A (zh) | 一种基于车联网的车辆防碰撞方法和系统 | |
| CN103754224A (zh) | 一种车辆多目标协调换道辅助自适应巡航控制方法 | |
| CN112572443B (zh) | 一种高速公路车辆换道实时避撞轨迹规划方法及系统 | |
| CN107380162B (zh) | 基于功能分配与多目标模糊决策的协同避撞方法 | |
| CN109799821A (zh) | 一种基于状态机的自动驾驶控制方法 | |
| CN108045373A (zh) | 一种自动驾驶纵向统一规划方法及系统 | |
| CN112092805B (zh) | 一种智能车辆避撞与降低碰撞伤害的集成控制方法和系统 | |
| CN110194156A (zh) | 智能网联混合动力汽车主动避撞增强学习控制系统和方法 | |
| CN116946137A (zh) | 一种基于驾驶意图的车路协同智能车辆换道防碰撞系统 | |
| CN115892063A (zh) | 一种无人驾驶商用车路况监控及应对方法 | |
| CN107878453B (zh) | 一种躲避动障碍物的汽车紧急避撞一体式控制方法 | |
| CN115649145B (zh) | 一种智能汽车转向和制动自适应协调控制系统 | |
| CN115140048B (zh) | 一种自动驾驶行为决策与轨迹规划模型与方法 | |
| Ding et al. | Research on safety lane change warning method based on potential angle collision point |
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 |