CN114407920A - 一种针对复杂路况的自动驾驶汽车的行驶速度优化方法 - Google Patents
一种针对复杂路况的自动驾驶汽车的行驶速度优化方法 Download PDFInfo
- Publication number
- CN114407920A CN114407920A CN202210007590.5A CN202210007590A CN114407920A CN 114407920 A CN114407920 A CN 114407920A CN 202210007590 A CN202210007590 A CN 202210007590A CN 114407920 A CN114407920 A CN 114407920A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- front wheel
- tire
- lateral force
- force
- 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 13
- 238000005457 optimization Methods 0.000 title abstract description 6
- 238000005452 bending Methods 0.000 claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000000418 atomic force spectrum Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000011002 quantification Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
- B60W60/0016—Planning or execution of driving tasks specially adapted for safety of the vehicle or its occupants
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种针对复杂路况的车辆行驶速度优化方法。包含以下步骤:结合车辆自身参数信息,根据车辆三自由度模型和魔术轮胎公式,得到车辆的运动学关系和速度‑曲率半径约束关系;当车辆转弯时,驶入弯道和驶出弯道对应不同的最大可执行前轮侧向力约束;入弯时纯侧偏工况下的轮胎力的线性区边界是此时的最大可执行前轮侧向力;出弯时通过引入轮胎摩擦圆计算得到轮胎在纵、侧向力联合作用下的最大可执行前轮侧向力;获得了不同的路面附着系数与最大可执行前轮侧向力的关系。代入在不同的路况下的最大可执行前轮侧向力,可以计算得到在相应路况下的最大极限稳定速度,以小于或等于该值的速度行驶可以保证车辆的稳定性。
Description
技术领域
本发明涉及车辆领域。特别涉及一种针对复杂路况的自动驾驶汽车侧向饱和约束下的行驶速度优化的方法。
背景技术
合理的行车速度规划是成功实现自动驾驶的前提,一直以来,大曲率转弯和低附着系数路面是速度规划的难题。与此紧密相关的车辆辅助驾驶***是介入自动驾驶***的过渡阶段,当车辆辅助驾驶***开始工作时车辆已发生失稳或有失稳倾向,缺少对于车辆行驶时的稳定边界的讨论。
在大曲率弯道和低附着系数路面上行驶时,由于提供给车辆转弯的轮胎侧向力的执行空间有限,不合理的行车速度极易导致车辆发生失稳。因此,找到在相应路况下车辆轮胎侧向力和行车速度的解析关系,获得一个能够使车辆稳定行驶的状态边界尤其是纵向速度的边界值是至关重要的,这样既可以保证车辆稳定又可以尽量提高行车效率。
发明内容
本发明的目的是当汽车在大曲率弯道和低附着系数路面上行驶时,能实时确定当前的最优行车速度,车辆按此速度行驶,既可以保证行驶过程平稳安全又可以提高行车效率。
一种针对复杂路况的自动驾驶汽车的行驶速度优化方法,包含以下步骤
步骤一:根据车辆三自由度动力学模型和轮胎魔术公式,结合车辆自身参数,包括整车质量和前后轴距,得到车辆在转弯时的运动学关系和基于最大可执行前轮侧向力的速度-曲率半径约束关系。
步骤二:根据GPS和车载传感器得到车辆前方预瞄距离内路径的曲率半径序列[ρ1,ρ2,…,ρn]、路面附着系数μ和纵向加速度ax,计算得到最小曲率半径ρmin,判断车辆此时的弯道行驶状态。
步骤三:根据步骤二中判断的弯道行驶状态,求解最大可执行前轮侧向力Fyf max;
步骤四:将步骤三求解的最大可执行前轮侧向力Fyf max带入步骤一中的速度-曲率半径约束关系,结合步骤二计算得到的ρmin并与运动学关系联合求解得到优化行驶速度。
所述步骤一中
(1)车辆三自由度动力学模型为
式中,Fxf为前轮纵向力,Fyf为前轮侧向力,Fxr为后轮纵向力,Fyr为后轮侧向力。δ为前轮转角,m为汽车质量,Vx为车身坐标系下汽车的纵向速度,Vy为车身坐标系下汽车的横向速度,为大地坐标系下车身的横摆角,为汽车横摆角速度,为汽车横摆角加速度,lf为车辆质心到前轴的距离,lr为车辆质心到后轴的距离,Iz为汽车的转动惯量。
(2)魔术轮胎公式为
FY=FY(α)=Dsin{Carctan[Bα-E(Bα-arctan(Bα))]} (4)
其中,输入量α为侧偏角,输出量FY为轮胎侧向力。D为峰值因子,为输出量FY的峰值,C为形状因子,能够影响所得曲线的形状,B为刚度因子,曲率因子E用来控制曲线峰值处的曲率,B、C、D和E均与具体的轮胎型号有关。
(3)轮胎的侧偏刚度为
(4)车辆在转弯时的运动学关系为
其中,Kf和Kr分别为前轮和后轮的侧偏刚度,ρ为汽车转弯时的曲率半径。
(5)基于最大可执行前轮侧向力的速度-曲率半径约束关系为
其中,af为前轮轮胎侧偏角。
所述步骤二中判断车辆弯道行驶状态如下
其中,ρmin为车辆行驶方向上一定距离内的最小曲率半径,ρ1为在车辆行驶方向上距离车头最近的观测点的曲率半径。
所述步骤三中
(1)前轮侧偏割线刚度为
其中,αfmax为前轮侧向力在纯侧偏工况下处于线性区内的最大侧偏角。
(2)轮胎侧向力与路面附着系数的关系为
(3)在入弯状态下的最大可执行前轮侧向力为
(4)对于前驱车辆,估计前轮纵向力为
(5)出弯状态下的最大可执行前轮侧向力为
其中,Fzf为前轮垂直载荷。
有益效果
本发明给出了一种在复杂路况下的自动驾驶汽车规划速度量化指导准则,在保证车辆侧向稳定的前提下尽可能地提高行车效率。
附图说明
图1为本发明所提出的复杂路况行车速度优化***原理图;
图2为本发明所采用的三自由度车辆模型图;
图3为本发明所提出的侧偏刚度校正示意图;
图4为本发明所采用的轮胎侧向力与路面附着系数关系示意图;
图5为本发明所提出的出弯状态下的最大可执行前轮侧向力示意图;
图6为本发明所提出的三种不同附着系数路面入弯状态下的优化速度;
图7为本发明所提出的三种不同纵向加速度出弯状态下的优化速度;
图8为本发明用于验证的参考轨迹;
图9为在三种附着系数路面上进行轨迹跟踪的横向偏差;
图10为在三种附着系数路面上进行轨迹跟踪的车辆速度;
图11为在三种附着系数路面上进行轨迹跟踪的前轮侧偏角。
具体实施方式
下面结合附图对提出的复杂路况下的速度优化方法进一步地阐述和说明。
如图1所示,本发明提出一种针对复杂路况的自动驾驶汽车的行驶速度优化方法,包括以下步骤:
步骤一、建立如图2所示的车辆自行车模型车辆模型和轮胎模型,根据侧向力曲线在原点的微分求取侧偏刚度,通过推导得到车辆在转弯时的运动学关系和基于最大可执行前轮侧向力的速度-曲率半径约束关系。
步骤二、根据GPS得到车辆前方一定预瞄距离内行驶路径的曲率半径序列[ρ1,ρ2,…,ρn]和路面附着系数μ,通过车载传感器得到纵向加速度ax,计算得到最小曲率半径ρmin,判断车辆此时的弯道行驶状态。
步骤六、根据步骤二中所判断弯道行驶状态,分别对应将式(12)或式(14)所描述的前轮最大可执行侧向力带入并替换式(7)中的前轮最大可执行侧向力,最后将式(6)和式(7)联合并结合步骤二中依据式(8)计算得到的ρmin求解即可得到当前车辆最优行驶速度,图6所示为三种不同附着系数路面入弯状态下的不同曲率半径对应的优化速度,图7所示以三种不同加速度出弯时不同曲率半径对应的优化速度。
下面给出本发明所提供的技术方案的仿真实验数据。
本实验仿真环境为使用CarSim和Simulink软件搭建的联合仿真平台,设计轨迹跟踪控制器模拟自动驾驶场景,验证所提出的优化速度的准确性。
图10所示为仿真车辆以优化速度为参考在不同附着系数路面上进行轨迹跟踪的车速,可以看到在纵向位移X=80、200和350m处车辆均主动调速为进入弯道做准备。图9所示为轨迹跟踪的横向偏差,图11所示为车辆在轨迹跟踪时的前轮侧偏角,可见按本发明提出的优化速度行驶可以保证车辆的横向稳定与轨迹跟踪效果。
Claims (3)
1.一种针对复杂路况的自动驾驶汽车的行驶速度优化方法,其特征在于,该方法包含以下步骤:
步骤一:根据车辆三自由度动力学模型和轮胎魔术公式,结合车辆自身参数,包括整车质量m和前后轴距,得到车辆在转弯时的运动学关系
Kf和Kr分别为前轮和后轮的侧偏刚度,ρ为汽车转弯时的曲率半径;
和基于最大可执行前轮侧向力的速度-曲率半径约束关系:
其中,Vx为车身坐标系下汽车的纵向速度,Fyfmax为最大可执行前轮侧向力,lf为车辆质心到前轴的距离,lr为车辆质心到后轴的距离,δ为前轮转角,αf为前轮轮胎侧偏角;
步骤二:根据GPS和车载传感器得到车辆前方预瞄距离内路径的曲率半径序列[ρ1,ρ2,…,ρn]、路面附着系数μ和纵向加速度ax,计算得到最小曲率半径ρmin并判断车辆此时的弯道行驶状态,
其中,ρ1为在车辆行驶方向上距离车头最近的观测点的曲率半径;
步骤三:根据步骤二中判断的弯道行驶状态,求解最大可执行前轮侧向力Fyfmax;
其中,αfmax为前轮侧向力在纯侧偏工况下处于线性区内的最大侧偏角,FY(αfmax)为经轮胎试验观测得到的处于该最大侧偏角时前轮的侧向力;μ0=1和α0=5°分别为参考路面附着系数和参考侧偏角。
其中,g为重力加速度;ax为步骤二中由车载传感器得到纵向加速度,m为步骤一中得到的整车质量,Fzf为前轮垂直载荷;
步骤四:将求解的最大可执行前轮侧向力Fyfmax和带入步骤一中的速度-曲率半径约束关系,结合步骤二计算得到的ρmin与步骤一中运动学关系联合求解得到优化行驶速度Vopt。
2.根据权利要求1所述的针对复杂路况的自动驾驶汽车的行驶速度优化方法,其特征在于,所述步骤一中
(1)车辆三自由度动力学模型为
式中,Fxf为前轮纵向力,Fyf为前轮侧向力,Fxr为后轮纵向力,Fyr为后轮侧向力。δ为前轮转角,m为汽车质量,Vx为车身坐标系下汽车的纵向速度,Vy为车身坐标系下汽车的横向速度,为大地坐标系下车身的横摆角,为汽车横摆角速度,为汽车横摆角加速度,lf为车辆质心到前轴的距离,lr为车辆质心到后轴的距离,Iz为汽车的转动惯量。
(2)魔术轮胎公式为
FY=FY(α)=Dsin{Carctan[Bα-E(Bα-arctan(Bα))]} (13)
其中,输入量α为侧偏角,输出量FY为轮胎侧向力。D为峰值因子,为输出量FY的峰值,C为形状因子,能够影响所得曲线的形状,B为刚度因子,曲率因子E用来控制曲线峰值处的曲率,B、C、D和E均与具体的轮胎型号有关。
(3)轮胎的侧偏刚度K为
式中,FY(α)为轮胎侧偏角为α时的轮胎侧向力;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210007590.5A CN114407920B (zh) | 2022-01-06 | 2022-01-06 | 一种针对复杂路况的自动驾驶汽车的行驶速度优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210007590.5A CN114407920B (zh) | 2022-01-06 | 2022-01-06 | 一种针对复杂路况的自动驾驶汽车的行驶速度优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114407920A true CN114407920A (zh) | 2022-04-29 |
CN114407920B CN114407920B (zh) | 2024-04-16 |
Family
ID=81270756
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210007590.5A Active CN114407920B (zh) | 2022-01-06 | 2022-01-06 | 一种针对复杂路况的自动驾驶汽车的行驶速度优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114407920B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11500379A (ja) * | 1995-11-25 | 1999-01-12 | イーテーテー・アウトモティーフェ・オイローペ・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツング | 摩擦係数に応じて基準ヨーレートを制限する走行安定性コントロールユニット |
EP0945320A1 (fr) * | 1998-03-24 | 1999-09-29 | Renault | Procédé de contrÔle du comportement dynamique d'un véhicule routier |
US20100010795A1 (en) * | 2006-09-01 | 2010-01-14 | Michelin Recherche Et Technique S.A. | Method for Simulating the Thermomechanical Behavior of a Tire Rolling on the Ground |
CN106649983A (zh) * | 2016-11-09 | 2017-05-10 | 吉林大学 | 用于无人驾驶车辆高速运动规划的车辆动力学模型建模方法 |
CN107512262A (zh) * | 2017-08-14 | 2017-12-26 | 吉林大学 | 一种针对执行驱动空间受限时的车辆稳定控制***轮胎力分配方法 |
CN108909703A (zh) * | 2018-06-27 | 2018-11-30 | 聊城大学 | 一种自动驾驶紧急避让的失稳可控域的判定方法 |
CN109976159A (zh) * | 2019-04-09 | 2019-07-05 | 台州学院 | 基于安全可控域的智能车辆横向控制方法 |
CN110040147A (zh) * | 2019-04-23 | 2019-07-23 | 吉林大学 | 一种自动驾驶汽车侧向饱和约束下的行驶速度优化的方法 |
CN111994085A (zh) * | 2020-08-25 | 2020-11-27 | 吉林大学 | 复杂路况下车辆行驶稳定区域的估计方法 |
CN113408062A (zh) * | 2021-07-09 | 2021-09-17 | 中国石油大学(华东) | 自动驾驶全工况路面自适应mpc轨迹跟踪控制及评价方法 |
-
2022
- 2022-01-06 CN CN202210007590.5A patent/CN114407920B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11500379A (ja) * | 1995-11-25 | 1999-01-12 | イーテーテー・アウトモティーフェ・オイローペ・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツング | 摩擦係数に応じて基準ヨーレートを制限する走行安定性コントロールユニット |
EP0945320A1 (fr) * | 1998-03-24 | 1999-09-29 | Renault | Procédé de contrÔle du comportement dynamique d'un véhicule routier |
US20100010795A1 (en) * | 2006-09-01 | 2010-01-14 | Michelin Recherche Et Technique S.A. | Method for Simulating the Thermomechanical Behavior of a Tire Rolling on the Ground |
CN106649983A (zh) * | 2016-11-09 | 2017-05-10 | 吉林大学 | 用于无人驾驶车辆高速运动规划的车辆动力学模型建模方法 |
CN107512262A (zh) * | 2017-08-14 | 2017-12-26 | 吉林大学 | 一种针对执行驱动空间受限时的车辆稳定控制***轮胎力分配方法 |
CN108909703A (zh) * | 2018-06-27 | 2018-11-30 | 聊城大学 | 一种自动驾驶紧急避让的失稳可控域的判定方法 |
CN109976159A (zh) * | 2019-04-09 | 2019-07-05 | 台州学院 | 基于安全可控域的智能车辆横向控制方法 |
CN110040147A (zh) * | 2019-04-23 | 2019-07-23 | 吉林大学 | 一种自动驾驶汽车侧向饱和约束下的行驶速度优化的方法 |
CN111994085A (zh) * | 2020-08-25 | 2020-11-27 | 吉林大学 | 复杂路况下车辆行驶稳定区域的估计方法 |
CN113408062A (zh) * | 2021-07-09 | 2021-09-17 | 中国石油大学(华东) | 自动驾驶全工况路面自适应mpc轨迹跟踪控制及评价方法 |
Non-Patent Citations (1)
Title |
---|
李玲;马力;牟宇;徐超;李文茹;施树明;: "模型车轮胎侧偏刚度的参数辨识方法", 汽车工程, no. 12, 25 December 2016 (2016-12-25), pages 1508 - 1514 * |
Also Published As
Publication number | Publication date |
---|---|
CN114407920B (zh) | 2024-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100903665B1 (ko) | 가가속도 정보를 이용한 차량의 운동 제어장치 | |
CN110040147B (zh) | 一种自动驾驶汽车侧向饱和约束下的行驶速度优化的方法 | |
CN106649983A (zh) | 用于无人驾驶车辆高速运动规划的车辆动力学模型建模方法 | |
JP7327223B2 (ja) | 自動操舵制御装置、自動操舵制御方法、および自動操舵プログラム | |
US10118609B2 (en) | Driving force control device for a vehicle | |
US9180880B2 (en) | Driving force control system for vehicle | |
CN111796522B (zh) | 一种车辆状态估计方法 | |
CN109017805B (zh) | 一种针对存在不确定性的行驶***车辆稳定性控制方法 | |
CN111845755B (zh) | 一种车辆纵向车速估计方法 | |
WO2018029914A1 (ja) | 車両状態量推定装置 | |
Rubin et al. | Vehicle yaw stability control using rear active differential via sliding mode control methods | |
CN114407920B (zh) | 一种针对复杂路况的自动驾驶汽车的行驶速度优化方法 | |
US11807249B2 (en) | Vehicle motion state estimation device, vehicle motion state estimation method, and vehicle | |
CN114148411B (zh) | 一种轮式无人平台的漂移控制方法 | |
CN108398949B (zh) | 一种松软路面智能农机自动驾驶方法 | |
CN110435636B (zh) | 一种考虑货物升降对叉车横向稳定性影响的优化控制方法 | |
CN113650621B (zh) | 面向复杂工况的分布式驱动电动汽车状态参数估计方法 | |
JP4949319B2 (ja) | 車両の駆動力制御装置 | |
CN115891972B (zh) | 一种可编组无轨电车稳定性控制方法及*** | |
JP3271964B1 (ja) | 車両の路面摩擦係数推定装置 | |
JP2020117040A (ja) | 車両の姿勢制御装置 | |
CN113032880B (zh) | 圆曲线路段设计合理性的评价方法 | |
Nozaki | Effect of the front and rear weight distribution ratio of a formula car during maximum-speed cornering on a circuit | |
CN115782897A (zh) | 车辆转向角度确定方法、装置、整车控制器及存储介质 | |
Wang et al. | Control of Vehicle Beyond the Stability Limits |
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 |