Nothing Special   »   [go: up one dir, main page]

CN109109861A - 车道保持横向控制决策方法及车道保持横向控制决策装置 - Google Patents

车道保持横向控制决策方法及车道保持横向控制决策装置 Download PDF

Info

Publication number
CN109109861A
CN109109861A CN201811111646.1A CN201811111646A CN109109861A CN 109109861 A CN109109861 A CN 109109861A CN 201811111646 A CN201811111646 A CN 201811111646A CN 109109861 A CN109109861 A CN 109109861A
Authority
CN
China
Prior art keywords
domain
vehicle
automobile
function
road
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
Application number
CN201811111646.1A
Other languages
English (en)
Other versions
CN109109861B (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.)
Hefei University of Technology
Original Assignee
Hefei University of Technology
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 Hefei University of Technology filed Critical Hefei University of Technology
Priority to CN201811111646.1A priority Critical patent/CN109109861B/zh
Publication of CN109109861A publication Critical patent/CN109109861A/zh
Application granted granted Critical
Publication of CN109109861B publication Critical patent/CN109109861B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/10—Path keeping
    • B60W30/12—Lane keeping
    • 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
    • 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
    • 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
    • B60W2050/0001—Details of the control system
    • B60W2050/0019—Control system elements or transfer functions
    • B60W2050/0028—Mathematical models, e.g. for simulation

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

本发明公开了一种车道保持横向控制决策方法及其车道保持横向控制决策装置。所述方法包括：提取特征量；划分可拓集合；计算关联函数K(s)；根据关联函数K(s)，确定特征量所在的域；在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重；确立人工势场函数。本发明在实现汽车在道路上行驶时，能够进行车道保持的功能，减少因车道偏离所带来的安全隐患，以提高行车的安全系数，其能在保障汽车进行车道保持的同时，还考虑了汽车的行驶和操纵稳定性。

Description

车道保持横向控制决策方法及车道保持横向控制决策装置
技术领域
本发明涉及智能汽车的辅助驾驶技术领域，尤其涉及一种车道保持横向控制决策方法及其车道保持横向控制决策装置。
背景技术
随着汽车技术的迅猛发展，车道保持系统在汽车主动安全技术领域扮演着越来越关键的角色，作为智能汽车核心技术之一，用于汽车当检测到有发生车道偏离的危险时，控制汽车回到道路中心线，或减少因疏忽及疲劳驾驶导致车道偏离引发的交通事故。在车道保持系统中，横向控制决策对车道保持的效果起到了至关重要的作用，好的控制策略和路径跟踪方法可以达到实时高效、可靠安全的车道跟随效果，而未考虑汽车行驶和操纵稳定性的人工势场法对车道保持的控制效果不够理想。
发明内容
本发明旨在实现汽车在道路上行驶时，能够进行车道保持的功能，减少因车道偏离所带来的安全隐患，以提高行车的安全系数，而提出的一种车道保持横向控制决策方法及其车道保持横向控制决策装置，其能在保障汽车进行车道保持的同时，还考虑了汽车的行驶和操纵稳定性。
本发明的解决方案是：一种车道保持横向控制决策方法，其包括：
步骤一，提取特征量；
其中，提取横摆角速度ω、汽车的纵向速度u为两个特征量，以ω为横坐标，以u为纵坐标，建立平面直角坐标系；
步骤二，划分可拓集合；
其中，将所述平面直角坐标系划分为经典域、可拓域和非域；
所述经典域在所述横坐标上的取值范围为[-ω1，ω1]，在所述纵坐标上的取值范围为[-u1，u1]，ω1代表汽车在稳定状态下的最大横摆角速度，u1代表汽车以低速行驶的最高纵向速度；
所述可拓域在所述横坐标上的取值范围为[-ω2，-ω1)∪(ω1，ω2]，在所述纵坐标上的取值范围为[-u2，-u1)∪(u1，u2]，ω2代表汽车在极限状态下的最大横摆角速度，u2代表汽车以高速行驶的最低纵向速度；
所述非域在所述横坐标上的取值范围为(-∞，-ω2)∪(ω2，+∞)，在所述纵坐标上的取值范围为(-∞，-u2)∪(u2，+∞)；
步骤三，计算关联函数K(s)；
其中，设所述平面直角坐标系的原点为S0(0,0)，令 则所述平面直角坐标系上存在一点S，坐标表示为S(ωi,ui)，设计S(ωi,ui)的关联函数为：
式中，Rgy为所述经典域；
步骤四，根据关联函数K(s)，确定特征量所在的域；
其中，当K(s)≤0时，特征量处于所述经典域内，当0＜K(s)＜1时，特征量处于所述可拓域内，当K(s)≥1时，特征量处于所述非域内；
步骤五，在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重γu、γω；
其中，特征量处于所述经典域内，则γu＝1，γω＝0；特征量处于所述可拓域内，γu＝K(s)，γω＝1-K(s)；特征量处于所述非域中，γu＝0，γω＝1；
步骤六，确立人工势场函数；
其中，人工势场函数为：U＝Uatt+Urep+γuUu+γωUs，
式中，Uatt是道路中心线对汽车的引力场函数，Urep是道路安全边界线对汽车的斥力场函数，Uu代表汽车与道路边界线相对速度对势场函数的影响，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数，γu为速度因子所占的控制比重，γω为横摆角因子所占的控制比重。
作为上述方案的进一步改进，Uatt为其中，c1为引力场函数增益，e1为e为汽车质心到道路中心线的距离，a为汽车质心到前轴的距离，c为前轴中心处到预瞄点的距离，为汽车的角度偏差。
作为上述方案的进一步改进，Urep为其中，e0为道路安全边界线到道路中心线的距离；e为汽车质心到道路中心线的距离，n为正整数；c2为斥力场函数增益。
作为上述方案的进一步改进，Uu为Uu＝c3u2en，其中，c3为速度场增益，u为汽车纵向速度，en是调节因子，n为正整数。
作为上述方案的进一步改进，Us为Us＝c4[θ(k+1)-θ(k)]2en，θ(k+1)和θ(k)分别代表k+1时刻和k时刻的横摆角；c4为横摆角速度场的增益，e为汽车质心到道路中心线的距离，n为正整数。
作为上述方案的进一步改进，汽车在稳定状态下最大横摆角速度ω1为：ω1＝μg/u，其中，u为汽车的纵向速度，μ为路面附着系数，g为重力加速度。
作为上述方案的进一步改进，汽车在极限状态下的最大横摆角速度ω2由汽车的前轮转角的最大值δm决定，
式中，u为汽车的纵向速度；αf、αr分别为前、后轴侧偏角的饱和值，a为汽车质心到前轴的距离，b为汽车质心到后轴的距离，μ为路面附着系数，g为重力加速度。
作为上述方案的进一步改进，所述车道保持横向控制决策方法还包括：
步骤七，调整汽车的车道保持横向控制器；
其中，将所述人工势场函数带入到表征所述车道保持横向控制器的二自由度车辆模型中，求得理想的前轮转角δ，将所述理想的前轮转角δ发送给所述车道保持横向控制器来控制汽车的横向运动。
进一步地，所述理想的前轮转角δ为：
其中，k1为汽车的前轮侧偏刚度，e为汽车的侧向距离偏差，为汽车的角度偏差。
作为上述方案的进一步改进，u1取30km/h，u2取60km/h。
本发明还提供一种车道保持横向控制决策装置，其应用上述任意车道保持横向控制决策方法，所述车道保持横向控制决策装置包括：
提取特征量模块，其用于提取特征量；
其中，提取横摆角速度ω、汽车的纵向速度u为两个特征量，以ω为横坐标，以u为纵坐标，建立平面直角坐标系；
可拓集合划分模块，其用于划分可拓集合；
其中，将所述平面直角坐标系划分为经典域、可拓域和非域；所述经典域在所述横坐标上的取值范围为[-ω1，ω1]，在所述纵坐标上的取值范围为[-u1，u1]，ω1代表汽车在稳定状态下的最大横摆角速度，u1代表汽车以低速行驶的最低纵向速度；
所述可拓域在所述横坐标上的取值范围为[-ω2，-ω1)∪(ω1，ω2]，在所述纵坐标上的取值范围为[-u2，-u1)∪(u1，u2]，ω2代表汽车在极限状态下的最大横摆角速度，u2代表汽车以高速行驶的最低纵向速度；
所述非域在所述横坐标上的取值范围为(-∞，-ω2)∪(ω2，+∞)，在所述纵坐标上的取值范围为(-∞，-u2)∪(u2，+∞)；
关联函数计算模块，其用于计算关联函数K(s)；
其中，设所述平面直角坐标系的原点为S0(0,0)，令 则所述平面直角坐标系上存在一点S，坐标表示为S(ωi,ui)，设计S(ωi,ui)的关联函数为：
式中，Rgy为所述经典域；
域确定模块，其用于根据关联函数K(s)，确定特征量所在的域；
其中，当K(s)≤0时，特征量处于所述经典域内，当0＜K(s)＜1时，特征量处于所述可拓域内，当K(s)≥1时，特征量处于所述非域内；
控制比重确定模块，其用于在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重γu、γω；
其中，特征量处于所述经典域内，则γu＝1，γω＝0；特征量处于所述可拓域内，γu＝K(s)，γω＝1-K(s)；特征量处于所述非域中，γu＝0，γω＝1；
人工势场函数确立模块，其用于确立人工势场函数；
其中，人工势场函数为：U＝Uatt+Urep+γuUu+γωUs，
式中，Uatt是道路中心线对汽车的引力场函数，Urep是道路安全边界线对汽车的斥力场函数，Uu代表汽车与道路边界线相对速度对势场函数的影响，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数，γu为速度因子所占的控制比重，γω为横摆角因子所占的控制比重。
本发明的有益效果包括：
(1)本发明提出的一种基于可拓人工势场的车道保持横向控制决策方法能够实现汽车在道路上行驶时进行车道保持的功能，减少因车道偏离所带来的安全隐患，以提高行车的安全系数；
(2)本发明提出的一种基于可拓人工势场的车道保持横向控制决策方法在保障汽车进行车道保持的同时，还能够维持汽车的行驶和操纵稳定性。
附图说明
图1为本发明的方法流程图。
图2为可拓集合划分图。
图3为实施例中FHWA仿真工况图。
图4为实施例中FHWA工况车速为20km/h侧向距离偏差结果对比图。
图5为实施例中FHWA工况车速为20km/h角度偏差结果对比图。
图6为实施例中FHWA工况车速为50km/h侧向距离偏差结果对比图。
图7为实施例中FHWA工况车速为50km/h角度偏差结果对比图。
图8为实施例中FHWA工况车速为80km/h侧向距离偏差结果对比图。
图9为实施例中FHWA工况车速为80km/h角度偏差结果对比图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
本发明公开一种车道保持横向控制决策方法，具体流程包括：(1)提取特征量，并以特征量为横纵坐标，建立平面直角坐标系；(2)划分可拓集合，确定集合边界值；(3)确立关联函数并计算关联度；(4)根据关联度的大小确定状态参数所在的域；(5)在不同的域内确定速度和横摆角速度对势场函数的控制比重；(6)确立人工势场函数，求得汽车前轮转角，控制汽车横向运动。优选地，在仅考虑引力、斥力和速度对势场函数影响的人工势场法的基础上，引入横摆角因子来降低横摆角的变化速率，从而维持汽车的行驶和操纵稳定性。
本发明的车道保持横向控制决策方法，如图1所示，包括以下几个步骤。
步骤一：提取特征量。
提取横摆角速度ω、汽车的纵向速度u为两个特征量，以ω为横坐标，以u为纵坐标，建立平面直角坐标系。
步骤二：划分可拓集合。
如图2所示，将所述平面直角坐标系划分为经典域、可拓域和非域。
所述经典域在所述横坐标上的取值范围为[-ω1，ω1]，在所述纵坐标上的取值范围为[-u1，u1]，ω1代表汽车在稳定状态下的最大横摆角速度，u1代表汽车以低速行驶的最低纵向速度。
所述可拓域在所述横坐标上的取值范围为[-ω2，-ω1)∪(ω1，ω2]，在所述纵坐标上的取值范围为[-u2，-u1)∪(u1，u2]，ω2代表汽车在极限状态下的最大横摆角速度，u2代表汽车以高速行驶的最低纵向速度。
所述非域在所述横坐标上的取值范围为(-∞，-ω2)∪(ω2，+∞)，在所述纵坐标上的取值范围为(-∞，-u2)∪(u2，+∞)。
汽车在稳定状态下最大横摆角速度ω1可由路面附着系数来确定，其计算表达式如：ω1＝μg/u。其中，u为汽车的纵向速度，μ为路面附着系数，g为重力加速度。
汽车在极限状态下的最大横摆角速度ω2由前轮转角的最大值δm决定，
式中，u为汽车的纵向速度；αf、αr分别为前、后轴侧偏角的饱和值，a为汽车质心到前轴的距离，b为汽车质心到后轴的距离，μ为路面附着系数，g为重力加速度。
u1、u2分别代表汽车以低、高速行驶，道路行驶的速度要求：一般60km/h以下为低速，60km/h以上为高速，30km/h位低速中的最低极限，120km/h为高速中的最高极限。结合实际情况，经多次仿真，这里u1取30km/h，u2取60km/h为宜。
步骤三：计算关联函数K(s)。
确立关联函数并计算关联度。
设ω-u特征平面的原点为S0(0,0)，令则ω-u特征平面上存在一点S(ωi,ui)，设计关联函数为其中，Rgy为经典域。
步骤四：根据关联函数K(s)，确定特征量所在的域。
当K(s)≤0时，特征量处于所述经典域内，当0＜K(s)＜1时，特征量处于所述可拓域内，当K(s)≥1时，特征量处于所述非域内；
步骤五，在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重γu、γω；
其中，特征量处于所述经典域内，则γu＝1，γω＝0；特征量处于所述可拓域内，γu＝K(s)，γω＝1-K(s)；特征量处于所述非域中，γu＝0，γω＝1。
步骤六，确立人工势场函数。
确立人工势场函数，求得汽车前轮转角，控制汽车横向运动。人工势场函数为：U＝Uatt+Urep+γuUu+γωUs，
式中，Uatt是道路中心线对汽车的引力场函数，Urep是道路安全边界线对汽车的斥力场函数，Uu代表汽车与道路边界线相对速度对势场函数的影响，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数，γu为速度因子所占的控制比重，γω为横摆角因子所占的控制比重。
将势场函数带入到二自由度车辆模型中，可求得理想的前轮转角，将其发送给汽车来控制汽车的横向运动。前轮转角如下式所示：其中，k1为前轮侧偏刚度，U为人工势场函数，e为侧向距离偏差，为角度偏差。
在考虑引力、斥力和速度对势场函数影响的人工势场法的基础上，引入横摆角因子来降低横摆角的变化速率，从而维持汽车的行驶和操纵稳定性。
人工势场应用于车道保持时，在考虑道路中心线对车辆的引力作用、道路安全边界线对车辆的斥力作用的基础上，考虑汽车与道路相对速度对势场函数的影响，其改进人工势场计算表达式可表示如下。
U＝Uatt+Urep+Uu
式中，Uatt是道路中心线对汽车的引力场函数，可表示为：
其中，c1为引力场函数增益，e1为e为汽车质心到道路中心线的距离，a为汽车质心到前轴的距离，c为前轴中心处到预瞄点的距离，为汽车的角度偏差。
Urep是道路安全边界线对汽车的斥力场函数，可表示为：
其中，e0为道路安全边界线到道路中心线的距离；en是调节因子，n一般取2；c2为斥力场函数增益。
Uu代表汽车与道路边界线相对速度对势场函数的影响，可表示为Uu＝c3ux 2en，其中，c3为速度场增益。
本发明在此基础上，引入横摆角因子来降低横摆角的变化速率，从而维持汽车的行驶和操纵稳定性。
当汽车横摆角变化速率过快时，汽车容易失稳，因此通过降低横摆角的变化速率来维持汽车具有较好的行驶和操纵稳定性，可拓势场函数表示如下。
U＝Uatt+Urep+Uu+Us
式中，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数。
Us＝c4[θ(k+1)-θ(k)]2en
其中，θ(k+1)和θ(k)分别代表(k+1)时刻和k时刻的横摆角；c4为横摆角速度场的增益。
为了证实本发明的可行性，对本发明进行了仿真实验。图3为实施例中采用FHWA作为仿真路线的仿真工况图，道路包含直线和转弯工况。图4、6、8为车速分别取20、50、80km/h时，汽车质心处距离道路中心线的侧向距离偏差结果对比图，对比分析得，本发明采用的可拓人工势场(U＝Uatt+Urep+γuUu+γωUs)相较于改进人工势场(U＝Uatt+Urep+Uu)，横向距离偏差分别下降了38.9％、45.5％、41.7％。图5、7、9为车速分别取20、50、80km/h时，汽车纵轴线与道路中心线之间夹角的角度偏差结果对比图，对比分析得，本发明采用的可拓人工势场相较于改进人工势场，角度偏差分别下降了54.5％、58.3％、65.4％。
针对本发明可以设计成以一种车道保持横向控制决策装置形式展现的软件，其应用本发明的车道保持横向控制决策方法。所述车道保持横向控制决策装置包括提取特征量模块、可拓集合划分模块、关联函数计算模块、域确定模块、控制比重确定模块、人工势场函数确立模块。
提取特征量模块用于提取特征量。其中，提取横摆角速度ω、汽车的纵向速度u为两个特征量，以ω为横坐标，以u为纵坐标，建立平面直角坐标系。
可拓集合划分模块用于划分可拓集合。其中，将所述平面直角坐标系划分为经典域、可拓域和非域；所述经典域在所述横坐标上的取值范围为[-ω1，ω1]，在所述纵坐标上的取值范围为[-u1，u1]，ω1代表汽车在稳定状态下的最大横摆角速度，u1代表汽车以低速行驶的最低纵向速度。
所述可拓域在所述横坐标上的取值范围为[-ω2，-ω1)∪(ω1，ω2]，在所述纵坐标上的取值范围为[-u2，-u1)∪(u1，u2]，ω2代表汽车在极限状态下的最大横摆角速度，u2代表汽车以高速行驶的最低纵向速度。
所述非域在所述横坐标上的取值范围为(-∞，-ω2)∪(ω2，+∞)，在所述纵坐标上的取值范围为(-∞，-u2)∪(u2，+∞)。
关联函数计算模块用于计算关联函数K(s)。其中，设所述平面直角坐标系的原点为S0(0,0)，令则所述平面直角坐标系上存在一点S，坐标表示为S(ωi,ui)，设计S(ωi,ui)的关联函数为：
式中，Rgy为所述经典域；
域确定模块用于根据关联函数K(s)，确定特征量所在的域。其中，当K(s)≤0时，特征量处于所述经典域内，当0＜K(s)＜1时，特征量处于所述可拓域内，当K(s)≥1时，特征量处于所述非域内。
控制比重确定模块用于在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重γu、γω。其中，特征量处于所述经典域内，则γu＝1，γω＝0；特征量处于所述可拓域内，γu＝K(s)，γω＝1-K(s)；特征量处于所述非域中，γu＝0，γω＝1。
人工势场函数确立模块用于确立人工势场函数。其中，人工势场函数为：U＝Uatt+Urep+γuUu+γωUs，式中，Uatt是道路中心线对汽车的引力场函数，Urep是道路安全边界线对汽车的斥力场函数，Uu代表汽车与道路边界线相对速度对势场函数的影响，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数，γu为速度因子所占的控制比重，γω为横摆角因子所占的控制比重。
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims (10)

1.一种车道保持横向控制决策方法，其特征在于，其包括：
步骤一，提取特征量；
其中，提取横摆角速度ω、汽车的纵向速度u为两个特征量，以ω为横坐标，以u为纵坐标，建立平面直角坐标系；
步骤二，划分可拓集合；
其中，将所述平面直角坐标系划分为经典域、可拓域和非域；
所述经典域在所述横坐标上的取值范围为[-ω1，ω1]，在所述纵坐标上的取值范围为[-u1，u1]，ω1代表汽车在稳定状态下的最大横摆角速度，u1代表汽车以低速行驶的最高纵向速度；
所述可拓域在所述横坐标上的取值范围为[-ω2，-ω1)∪(ω1，ω2]，在所述纵坐标上的取值范围为[-u2，-u1)∪(u1，u2]，ω2代表汽车在极限状态下的最大横摆角速度，u2代表汽车以高速行驶的最低纵向速度；
所述非域在所述横坐标上的取值范围为(-∞，-ω2)∪(ω2，+∞)，在所述纵坐标上的取值范围为(-∞，-u2)∪(u2，+∞)；
步骤三，计算关联函数K(s)；
其中，设所述平面直角坐标系的原点为S0(0,0)，令 则所述平面直角坐标系上存在一点S，坐标表示为S(ωi,ui)，设计S(ωi,ui)的关联函数为：
式中，Rgy为所述经典域；
步骤四，根据关联函数K(s)，确定特征量所在的域；
其中，当K(s)≤0时，特征量处于所述经典域内，当0＜K(s)＜1时，特征量处于所述可拓域内，当K(s)≥1时，特征量处于所述非域内；
步骤五，在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重γu、γω；
其中，特征量处于所述经典域内，则γu＝1，γω＝0；特征量处于所述可拓域内，γu＝K(s)，γω＝1-K(s)；特征量处于所述非域中，γu＝0，γω＝1；
步骤六，确立人工势场函数；
其中，人工势场函数为：U＝Uatt+Urep+γuUu+γωUs，
式中，Uatt是道路中心线对汽车的引力场函数，Urep是道路安全边界线对汽车的斥力场函数，Uu代表汽车与道路边界线相对速度对势场函数的影响，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数，γu为速度因子所占的控制比重，γω为横摆角因子所占的控制比重。
2.如权利要求1所述的车道保持横向控制决策方法，其特征在于，Uatt为其中，c1为引力场函数增益，e1为e为汽车质心到道路中心线的距离，a为汽车质心到前轴的距离，c为前轴中心处到预瞄点的距离，为汽车的角度偏差。
3.如权利要求1所述的车道保持横向控制决策方法，其特征在于，Urep为其中，e0为道路安全边界线到道路中心线的距离；en是调节因子，e为汽车质心到道路中心线的距离，n为正整数；c2为斥力场函数增益。
4.如权利要求1所述的车道保持横向控制决策方法，其特征在于，Uu为Uu＝c3u2en，其中，c3为速度场增益，u为汽车纵向速度，en是调节因子，n为正整数。
5.如权利要求1所述的车道保持横向控制决策方法，其特征在于，Us为Us＝c4[θ(k+1)-θ(k)]2en，θ(k+1)和θ(k)分别代表k+1时刻和k时刻的横摆角；c4为横摆角速度场的增益，e为汽车质心到道路中心线的距离，n为正整数。
6.如权利要求1所述的车道保持横向控制决策方法，其特征在于，汽车在稳定状态下最大横摆角速度ω1为：ω1＝μg/u，其中，u为汽车的纵向速度，μ为路面附着系数，g为重力加速度。
7.如权利要求1所述的车道保持横向控制决策方法，其特征在于，汽车在极限状态下的最大横摆角速度ω2由汽车的前轮转角的最大值δm决定，
式中，u为汽车的纵向速度；αf、αr分别为前、后轴侧偏角的饱和值，a为汽车质心到前轴的距离，b为汽车质心到后轴的距离，μ为路面附着系数，g为重力加速度。
8.如权利要求1所述的车道保持横向控制决策方法，其特征在于，所述车道保持横向控制决策方法还包括：
步骤七，调整汽车的车道保持横向控制器；
其中，将所述人工势场函数带入到表征所述车道保持横向控制器的二自由度车辆模型中，求得理想的前轮转角δ，将所述理想的前轮转角δ发送给所述车道保持横向控制器来控制汽车的横向运动。
9.如权利要求8所述的车道保持横向控制决策方法，其特征在于，所述理想的前轮转角δ为：
其中，k1为汽车的前轮侧偏刚度，e为汽车的侧向距离偏差，为汽车的角度偏差。
10.一种车道保持横向控制决策装置，其特征在于，其应用如权利要求1至9中任意一项所述的车道保持横向控制决策方法，所述车道保持横向控制决策装置包括：
提取特征量模块，其用于提取特征量；
其中，提取横摆角速度ω、汽车的纵向速度u为两个特征量，以ω为横坐标，以u为纵坐标，建立平面直角坐标系；
可拓集合划分模块，其用于划分可拓集合；
其中，将所述平面直角坐标系划分为经典域、可拓域和非域；所述经典域在所述横坐标上的取值范围为[-ω1，ω1]，在所述纵坐标上的取值范围为[-u1，u1]，ω1代表汽车在稳定状态下的最大横摆角速度，u1代表汽车以低速行驶的最高纵向速度；
所述可拓域在所述横坐标上的取值范围为[-ω2，-ω1)∪(ω1，ω2]，在所述纵坐标上的取值范围为[-u2，-u1)∪(u1，u2]，ω2代表汽车在极限状态下的最大横摆角速度，u2代表汽车以高速行驶的最低纵向速度；
所述非域在所述横坐标上的取值范围为(-∞，-ω2)∪(ω2，+∞)，在所述纵坐标上的取值范围为(-∞，-u2)∪(u2，+∞)；
关联函数计算模块，其用于计算关联函数K(s)；
其中，设所述平面直角坐标系的原点为S0(0,0)，令 则所述平面直角坐标系上存在一点S，坐标表示为S(ωi,ui)，设计S(ωi,ui)的关联函数为：
式中，Rgy为所述经典域；
域确定模块，其用于根据关联函数K(s)，确定特征量所在的域；
其中，当K(s)≤0时，特征量处于所述经典域内，当0＜K(s)＜1时，特征量处于所述可拓域内，当K(s)≥1时，特征量处于所述非域内；
控制比重确定模块，其用于在不同的域内，确定纵向速度u和横摆角速度ω对势场函数的两个控制比重γu、γω；
其中，特征量处于所述经典域内，则γu＝1，γω＝0；特征量处于所述可拓域内，γu＝K(s)，γω＝1-K(s)；特征量处于所述非域中，γu＝0，γω＝1；
人工势场函数确立模块，其用于确立人工势场函数；
其中，人工势场函数为：U＝Uatt+Urep+γuUu+γωUs，
式中，Uatt是道路中心线对汽车的引力场函数，Urep是道路安全边界线对汽车的斥力场函数，Uu代表汽车与道路边界线相对速度对势场函数的影响，Us是为了降低汽车的横摆角的变化速率，提高车身稳定性而引入的势场函数，γu为速度因子所占的控制比重，γω为横摆角因子所占的控制比重。
CN201811111646.1A 2018-09-24 2018-09-24 车道保持横向控制决策方法及车道保持横向控制决策装置 Active CN109109861B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811111646.1A CN109109861B (zh) 2018-09-24 2018-09-24 车道保持横向控制决策方法及车道保持横向控制决策装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811111646.1A CN109109861B (zh) 2018-09-24 2018-09-24 车道保持横向控制决策方法及车道保持横向控制决策装置

Publications (2)

Publication Number Publication Date
CN109109861A true CN109109861A (zh) 2019-01-01
CN109109861B CN109109861B (zh) 2020-02-14

Family

ID=64856249

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811111646.1A Active CN109109861B (zh) 2018-09-24 2018-09-24 车道保持横向控制决策方法及车道保持横向控制决策装置

Country Status (1)

Country Link
CN (1) CN109109861B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109795477A (zh) * 2019-02-22 2019-05-24 百度在线网络技术（北京）有限公司 消除稳态横向偏差的方法、装置及存储介质
CN110356405A (zh) * 2019-07-23 2019-10-22 桂林电子科技大学 车辆辅助行驶方法、装置、计算机设备及可读存储介质
CN111016893A (zh) * 2019-12-13 2020-04-17 江苏大学 一种拥堵环境下智能车辆可拓博弈车道保持自适应巡航控制系统与控制方法
CN111605549A (zh) * 2020-05-06 2020-09-01 南京航空航天大学 一种基于可拓逻辑的智能车道保持系统及控制方法
CN111674386A (zh) * 2020-05-15 2020-09-18 武汉科技大学 基于afs和dyc的车辆协调控制方法、装置及存储介质
CN112078578A (zh) * 2020-08-11 2020-12-15 江苏大学 一种车道保持系统中面对感知不确定性的自车位置规划方法
CN112455533A (zh) * 2020-10-29 2021-03-09 天水师范学院 一种用于自动驾驶汽车的转向助力方法
CN112622898A (zh) * 2020-12-17 2021-04-09 北京汽车研究总院有限公司 基于车道中心的车辆控制方法、装置及车辆
CN112965471A (zh) * 2021-02-10 2021-06-15 大连理工大学 一种考虑角速度约束和改进斥力场的人工势场路径规划方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050222731A1 (en) * 2004-03-30 2005-10-06 Ghoneim Youssef A Method and apparatus for estimating steering behavior for integrated chassis control
CN103996053A (zh) * 2014-06-05 2014-08-20 中交第一公路勘察设计研究院有限公司 基于机器视觉的车道偏离报警方法
JP2015020584A (ja) * 2013-07-19 2015-02-02 日産自動車株式会社 車両用レーン認識装置
CN104955701A (zh) * 2013-01-23 2015-09-30 丰田自动车株式会社 车辆控制装置
CN105263785A (zh) * 2013-06-14 2016-01-20 日立汽车系统株式会社 车辆控制系统
CN105593776A (zh) * 2013-08-01 2016-05-18 日产自动车株式会社 车辆位置姿势角推定装置及车辆位置姿势角推定方法
JP2017047705A (ja) * 2015-08-31 2017-03-09 富士重工業株式会社 車両の挙動制御装置及び車両の挙動制御方法
DE102016221574A1 (de) * 2016-11-03 2018-05-03 Bayerische Motoren Werke Aktiengesellschaft Fahrzeugsystem und Verfahren zur automatisierten Durchführung eines Spurwechselmanövers mit einer Funktionalität zur Feststellung der Freigabe eines temporären Seitenstreifens
US20180188739A1 (en) * 2016-12-29 2018-07-05 Automotive Research & Testing Center Automatic lane following control system and method for vehicles
JP2018103862A (ja) * 2016-12-27 2018-07-05 トヨタ自動車株式会社 運転支援装置
CN108327717A (zh) * 2018-02-06 2018-07-27 合肥工业大学 一种人机共驾的车道偏离辅助系统及其车道偏离辅助方法
CN108437989A (zh) * 2018-04-09 2018-08-24 广州大学 一种基于动态车道边界的车道偏离预警方法及系统

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050222731A1 (en) * 2004-03-30 2005-10-06 Ghoneim Youssef A Method and apparatus for estimating steering behavior for integrated chassis control
CN104955701A (zh) * 2013-01-23 2015-09-30 丰田自动车株式会社 车辆控制装置
CN105263785A (zh) * 2013-06-14 2016-01-20 日立汽车系统株式会社 车辆控制系统
JP2015020584A (ja) * 2013-07-19 2015-02-02 日産自動車株式会社 車両用レーン認識装置
CN105593776A (zh) * 2013-08-01 2016-05-18 日产自动车株式会社 车辆位置姿势角推定装置及车辆位置姿势角推定方法
CN103996053A (zh) * 2014-06-05 2014-08-20 中交第一公路勘察设计研究院有限公司 基于机器视觉的车道偏离报警方法
JP2017047705A (ja) * 2015-08-31 2017-03-09 富士重工業株式会社 車両の挙動制御装置及び車両の挙動制御方法
DE102016221574A1 (de) * 2016-11-03 2018-05-03 Bayerische Motoren Werke Aktiengesellschaft Fahrzeugsystem und Verfahren zur automatisierten Durchführung eines Spurwechselmanövers mit einer Funktionalität zur Feststellung der Freigabe eines temporären Seitenstreifens
JP2018103862A (ja) * 2016-12-27 2018-07-05 トヨタ自動車株式会社 運転支援装置
US20180188739A1 (en) * 2016-12-29 2018-07-05 Automotive Research & Testing Center Automatic lane following control system and method for vehicles
CN108327717A (zh) * 2018-02-06 2018-07-27 合肥工业大学 一种人机共驾的车道偏离辅助系统及其车道偏离辅助方法
CN108437989A (zh) * 2018-04-09 2018-08-24 广州大学 一种基于动态车道边界的车道偏离预警方法及系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
汪洪波: "基于功能分配的汽车底盘集成系统协调控制与稳定性分析", 《合肥工业大学博士学位论文》 *
陈无畏 等: "基于可拓决策和人工势场法的车道偏离辅助系统研究", 《机械工程学报》 *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109795477A (zh) * 2019-02-22 2019-05-24 百度在线网络技术（北京）有限公司 消除稳态横向偏差的方法、装置及存储介质
US11447141B2 (en) 2019-02-22 2022-09-20 Apollo Intelligent Driving Technology (Beijing) Co., Ltd. Method and device for eliminating steady-state lateral deviation and storage medium
CN110356405B (zh) * 2019-07-23 2021-02-02 桂林电子科技大学 车辆辅助行驶方法、装置、计算机设备及可读存储介质
CN110356405A (zh) * 2019-07-23 2019-10-22 桂林电子科技大学 车辆辅助行驶方法、装置、计算机设备及可读存储介质
CN111016893A (zh) * 2019-12-13 2020-04-17 江苏大学 一种拥堵环境下智能车辆可拓博弈车道保持自适应巡航控制系统与控制方法
CN111016893B (zh) * 2019-12-13 2021-08-03 江苏大学 一种拥堵环境下智能车辆可拓博弈车道保持自适应巡航控制系统与控制方法
CN111605549A (zh) * 2020-05-06 2020-09-01 南京航空航天大学 一种基于可拓逻辑的智能车道保持系统及控制方法
CN111674386A (zh) * 2020-05-15 2020-09-18 武汉科技大学 基于afs和dyc的车辆协调控制方法、装置及存储介质
CN112078578A (zh) * 2020-08-11 2020-12-15 江苏大学 一种车道保持系统中面对感知不确定性的自车位置规划方法
CN112455533A (zh) * 2020-10-29 2021-03-09 天水师范学院 一种用于自动驾驶汽车的转向助力方法
CN112455533B (zh) * 2020-10-29 2021-12-14 天水师范学院 一种用于自动驾驶汽车的转向助力方法
CN112622898A (zh) * 2020-12-17 2021-04-09 北京汽车研究总院有限公司 基于车道中心的车辆控制方法、装置及车辆
CN112965471A (zh) * 2021-02-10 2021-06-15 大连理工大学 一种考虑角速度约束和改进斥力场的人工势场路径规划方法

Also Published As

Publication number Publication date
CN109109861B (zh) 2020-02-14

Similar Documents

Publication Publication Date Title
CN109109861B (zh) 车道保持横向控制决策方法及车道保持横向控制决策装置
CN101712320B (zh) 车辆的速度控制装置
CN103057546B (zh) 车辆控制设备以及车辆控制方法
CN109969183A (zh) 基于安全可控域的弯道跟车控制方法
US20110087398A1 (en) Gps based pitch sensing for an integrated stability control system
CN105172791A (zh) 一种智能自适应巡航控制方法
CN107490968A (zh) 自动驾驶汽车的自适应分层递阶路径跟踪控制方法
CN106515716A (zh) 轮式驱动电动汽车底盘集成控制系统协调控制装置及方法
CN106696956A (zh) 具路径误差修正的车辆轨迹追踪装置及方法
CN105270397B (zh) 车辆电子稳定性控制系统稳定性控制判据的制定方法
JP2003146154A (ja) 車両状態量の推定方法
CN110040147A (zh) 一种自动驾驶汽车侧向饱和约束下的行驶速度优化的方法
CN109291932A (zh) 基于反馈的电动汽车横摆稳定性实时控制装置及方法
CN108573109B (zh) 一种基于Carsim仿真的公路圆曲线路段限速值计算方法
CN103600744A (zh) 四轮转向/驱动车辆的路径保持和车轮侧滑的控制方法
CN206781743U (zh) 具有多种避撞模式的汽车差速转向系统
KR20200017571A (ko) 자율주행 차량을 위한 횡방향 제어 파라미터 보정 장치 및 방법
Jäger et al. Torque-vectoring stability control of a four wheel drive electric vehicle
KR101899998B1 (ko) 이동 경로를 따라 차량이 주행하는 중에 차량의 속도를 수정하기 위한 시스템 및 방법
CN112298173A (zh) 一种面向智能驾驶的车辆安全行驶控制系统及控制方法
US20040227399A1 (en) Braking force control apparatus and method for vehicle
CN103796891B (zh) 车辆控制装置
CN110703775A (zh) 一种基于改进人工势场的商用车车道保持路径规划方法
Freeman et al. A comparison of multiple control strategies for vehicle run-off-road and return
KR20140121056A (ko) 조향 제어 장치 및 조향 특성 제어 방법

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