CN113401112B - 一种失控车辆再稳定的控制方法 - Google Patents
一种失控车辆再稳定的控制方法 Download PDFInfo
- Publication number
- CN113401112B CN113401112B CN202110650218.1A CN202110650218A CN113401112B CN 113401112 B CN113401112 B CN 113401112B CN 202110650218 A CN202110650218 A CN 202110650218A CN 113401112 B CN113401112 B CN 113401112B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- road
- state
- drift
- angle
- 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
- 238000000034 method Methods 0.000 title claims abstract description 66
- 238000011105 stabilization Methods 0.000 title claims description 12
- 230000005484 gravity Effects 0.000 claims abstract description 43
- 230000001133 acceleration Effects 0.000 claims description 24
- 230000006870 function Effects 0.000 claims description 12
- 238000005457 optimization Methods 0.000 claims description 12
- 125000000205 L-threonino group Chemical group [H]OC(=O)[C@@]([H])(N([H])[*])[C@](C([H])([H])[H])([H])O[H] 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 9
- 239000013598 vector Substances 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 6
- QERYCTSHXKAMIS-UHFFFAOYSA-M thiophene-2-carboxylate Chemical compound [O-]C(=O)C1=CC=CS1 QERYCTSHXKAMIS-UHFFFAOYSA-M 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 4
- 230000016776 visual perception Effects 0.000 claims description 4
- 238000001514 detection method Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 230000006641 stabilisation Effects 0.000 claims description 2
- 230000003137 locomotive effect Effects 0.000 claims 1
- 238000004458 analytical method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 230000002146 bilateral effect Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000012545 processing 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
- 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/02—Control of vehicle driving stability
-
- 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
-
- 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/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
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
本发明涉及一种失控车辆再稳定的控制方法,该方法利用传感器信息对路面进行建模,使用θ角和α角表征当前车身与路面的相对角度关系;之后判断车辆是否处于失控状态;如果是,则考虑重力分量建立车辆的漂移动力学模型,并以当前车辆状态为初始条件,考虑环境边界,优化求取漂移稳态,控制车辆维持漂移稳态;之后计算车辆与道路的相对姿态,判断是否满足驶出漂移稳态的条件;如果是,则控制车辆脱离漂移状态,进入正常行驶状态;当满足移交车辆控制权条件时,则向驾驶员或者其他自动驾驶控制模块移交控制权。该方法有效解决大侧偏角失控车辆无法自动进入稳定状态的技术难题。
Description
技术领域
本发明属于自动驾驶技术领域,具体涉及一种失控车辆重新进入稳定状态的控制方法。
背景技术
车辆侧滑(尤其是后轮侧滑)导致的车辆失控对安全行车有较大威胁,是造成碰撞、翻车等恶性交通事故的主要原因之一。据统计,有超过一半的侧滑导致的事故是在驾驶员制动和转弯时发生的,因此,车辆稳定性系统的研发被高度重视。
车身电子稳定系统(ESP,Electronic Stability Program)即是通过对各传感器的信息进行分析,然后向防抱死刹车系统(ABS,Anti-lock Brake System)、电子刹车分配力系统(EBD,Electrical Brake Distribution)等发送指令,精确调节各车轮的制动力并对侧向力施加影响,从而提高车辆的操控性能,防止车辆达到其动态极限时失控,有效地检测并预防车辆侧滑。
虽然当前大部分车辆都安装有ESP,但当车辆受到突然的外部刺激或者处于极端场景而导致侧滑已然发生,且产生较大的侧偏角,那么此时ESP是无法有效地预防事故发生的。比如,高速行驶中猛打方向,在下坡或雨雪湿滑路面紧急制动、转弯等,极易发生侧滑;此时,经验丰富的驾驶员可以依赖已有经验沉着应对,但大部分驾驶员可能不知所措,导致事故发生。
为解决车辆侧滑失控的技术问题,目前主要采取下述方案:
(1)中国专利CN108839652A公开的《一种车辆失稳可控域的自动驾驶紧急避让系统》,该专利利用通用的车辆非线性动力学模型,基于分叉理论计算失稳可控区域的联动控制区域,将数据分别传送给前轮控制系统和后轮控制系统,通过转向助力系统EPS和车身电子稳定系统ESP等执行计算结果,最终实现紧急避让障碍物。该发明的主要创新点是基于分叉理论计算车辆失稳可控域及相关的稳定性分析,但未考虑特殊场景下重力分量对于车辆动力学模型的影响,且未讨论环境约束对于失稳状态的影响及车辆退出失稳区域的机制和方法。
(2)英国专利GB2492543B公开的《A vehicle sideslip control system andmethod》,该专利涉及一种侧偏角保持的控制方法,提出了在转弯时保持非零侧偏角的控制系统,该系统包含一种控制器来产生应用于车轮的正或负的驱动力,从而保持相对于期望路径的侧偏角。该专利提出了进入和退出控制系统的条件,但未讨论特殊场景对于车辆动力学模型、大侧偏角状态的转弯半径及控制方法退出的影响。
(3)论文《Steady-state drifting stabilization of RWD vehicles》(Veleniset al.2011),涉及一种车辆在大侧偏角下维持漂移稳态的控制方法,该方法建立车辆的动力学模型,针对特定稳态,使用backstepping控制器对车辆进行控制,使车辆维持漂移稳态。该方法仅涉及漂移稳态的求解及控制,未考虑在斜坡场景下重力因素对于动力学模型的影响,且无驶出控制方法。
发明内容
本发明的目的在于提供一种失控车辆再稳定的控制方法,该方法针对大侧偏角的失控车辆,在有空间约束的环境中,提出利用车辆漂移控制技术将车从失控状态调整到漂移稳态,再驶出漂移稳态进入可操控状态,该方法有效解决大侧偏角失控车辆无法自动进入稳定状态的技术难题。
为实现上述目的,本发明采用如下技术方案:
一种失控车辆再稳定的控制方法,具体包括以下步骤:
步骤S1、获取传感器信息,利用重力加速度、车辆加速度、轮胎力信息建立路面模型,使用θ角和α角表征当前车身与路面的相对角度关系;其中,θ为路面法向量与世界坐标系Z轴的夹角,α为车头朝向和处于地面切平面上的重力分量的夹角;
步骤S2、依据车辆侧偏角的大小,同时结合后轮所受到的侧向力大小,判断车辆是否处于失控状态;如果是,则考虑重力分量建立车辆的漂移动力学模型,之后以当前车辆状态为初始条件,考虑环境边界,优化求取漂移稳态;
步骤S3、利用反馈控制方法按照步骤S2求得的稳态解控制车辆维持漂移稳态;
步骤S4、获取车道信息,计算车辆与道路的相对姿态,判断是否满足驶出漂移稳态的条件;如果是,则使用驶出控制方法控制车辆脱离漂移状态,进入正常行驶状态;
步骤S5、判断是否满足移交车辆控制权条件;如果是,则向驾驶员或者其他自动驾驶控制模块移交控制权。
作为本发明的优选,步骤S1中θ角和α角的计算过程如下:
考虑到车辆本身的roll和pitch角,建立如下关系式:
maxcosφpitch=∑Fijx+mg sinθcosα (1)
maycosφroll=∑Fijy+mg sinθsinα (2)
其中,m为车辆质量,g为重力加速度,θ为路面法向量与世界坐标系Z轴的夹角,α为车头朝向和处于地面切平面上的重力分量的夹角,φroll为车辆绕车辆坐标系x轴的旋转角度,φpitch为车辆绕车辆坐标系y轴的旋转角度,Fijx,Fijy为车轮所受到的纵向力和侧向力,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;ax为车辆纵向加速度,ay为车辆侧向加速度;
由(1)和(2)可得到:
对θ进行判断,若|θ|≤θthres,则可认为当前路面为绝对平面,此时α为任意值,其中θthres为预先设定的阈值;
若|θ|>θthres,α可按公式(4)求解:
α为与车头方向有关的变量,取值范围为(-π,π],在局部范围内,θ与道路设计有关,可认为是常量,取值范围应满足道路设计指标。
作为本发明的优选,步骤S2中车辆的漂移动力学模型如下:
其中,车辆围绕车辆坐标系z轴的旋转角速度表示为则角加速度为车头朝向和处于地面切平面上的重力分量的夹角α、车辆重心速度V、车身侧偏角β关于时间的导数分别记为和各个车轮的转速及转速关于时间的导数分别记为ωij和i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;Iz为车身绕车辆坐标系z轴的转动惯量,Iw为车轮的转动惯量,Tij为施加在各车轮上的驱动力矩,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;rw为车轮半径;δ为前轮转角;β为车辆侧偏角;D为同一轮轴上两轮的轮心距;Lf为重心与前轮轴水平距离;Lr为重心与后轮轴水平距离;
对于轮胎力Fijx和Fijy,可表示为:
摩擦系数同样可表示为类似函数:
计算载荷转移时,同样需要考虑重力分量的影响:
两个前轮垂向力合力为
两个后轮垂向力合力为
其中,h为车辆重心离地面高度;
若假设
由公式(12)和(13),可以计算得到四个车轮的垂向力如下:
综上,在倾斜平面上考虑载荷转移的车辆的漂移动力学模型即可建立。
作为本发明的优选,步骤S2中优化求解漂移稳态时,只需考虑单侧边界对于漂移的约束,以向右侧侧滑为例,优化求解漂移稳态的过程如下:
假设右侧道路边界已通过视觉感知系统得到,可以表示为y边界=C0+C1x+C2x2+C3x3,该多项式曲线为道路边界在车辆坐标系中的表示;其中,点(x,y边界)为边界曲线上的点在车辆坐标系下的坐标,C0,C1,C2,C3为多项式系数;
当车辆以侧偏角β进行逆时针稳态漂移,稳态漂移轨迹可以表示为当前时刻车辆坐标系下的圆,该圆圆心(xO,yo)满足如下关系:
则该圆的方程为:
(x+R sinβ)2+(y漂移-R cosβ)2=R2 (20)
因车辆向右侧侧滑,所以x=0时,y边界一定为负,这样仅需令漂移圆满足边界条件:y漂移>y边界+d膨胀,即:
其中,d膨胀是为安全考虑而预先给定的膨胀深度;此不等式方程不易求解,可以将x在(0,R(1-sinβ)]区间离散化后,建立多个点处的不等式约束;假设将(0,R(1-sinβ)]采样N个点则可建立不等式方程组:
将当前时刻车速V、车辆侧偏角β作为稳态常量,将动力学模型(5)-(18)离散化,建立目标函数
作为本发明的优选,步骤S4中计算车辆与道路的相对姿态的过程如下:
首先需要获取两侧车道线或者道路边界曲线方程,假设通过感知模块感知得到的左侧车道线或者路边界在车辆坐标系中的曲线方程为y=C0L+C1Lx+C2Lx2+C3Lx3,右侧车道线或者路边界在车辆坐标系中的曲线方程为y=C0R+C1Rx+C2Rx2+C3Rx3,其中,C0L~C3L、C0R~C3R是各曲线方程的多项式系数;
之后根据道路边界曲线方程计算道路方向ζ,计算道路方向的方法是:
(1)获取加权权值:
(2)将左、右两条曲线在x=0点处的切线方向与车辆坐标系X轴的夹角分别表示为ζL和ζR,则获取两侧朝向:
(3)将当前道路相对于车辆坐标系的方向角表示为ζ,则可获取道路朝向:
ζ=pζL+qζR (26)
最后对侧滑方向进行判断,并根据计算得到的道路方向ζ判断车头指向;在对侧滑方向判断时,如是向左侧滑,则判断ζ>0?;是,则车头指向道路内侧;否,则判断ζ=0?;是,则车头与道路方向平行;否,则车头指向道路外侧;如不是向左侧滑,则判断ζ<0?;是,则车头指向道路内侧;否,则判断ζ=0?;是,则车头与道路方向平行;否,则车头指向道路外侧。
作为本发明的进一步优选,步骤S4中驶出漂移稳态的判断过程如下:
基于得到的车头指向,需要考虑以下三种情况,以判断是否驶出:
(1)判断车头是否朝向道路外侧?如当车头方向指向道路外侧时,则继续进行稳态漂移控制;
(2)判断车头方向与道路方向是否平行?将道路方向角的绝对值记为|ζ|,当|ζ|在误差范围内,则可认为当前车头方向与道路方向平行,可根据当前道路双侧的曲线方程计算理想驶出状态并进行驶出控制;
(3)判断稳态漂移时间是否大于阈值?如当车头方向指向道路内侧且漂移状态持续时间超过规定时间,则驶出状态按照道路单侧曲线方程计算并进行驶出控制。
作为本发明的进一步优选,步骤S4中驶出控制方法的具体控制过程如下:
确定驶出状态,如车头方向与道路方向平行,此时,驶出状态需要与道路方向相适应,驶出的轨迹是圆弧或者直线,具体计算流程如下:
(1)记左、右两条曲线在x=0点处的曲率为κL和κR,使用双侧车道线或者道路边界曲线方程计算双侧曲率:
(2)记当前道路曲率为κ,使用加权权值计算驶出曲率:
κ=pκL+qκR (28)
(3)驶出速度为当前车速V,计算驶出角速度:
(4)驶出侧偏角应满足|β|<βmax,其中βmax为车辆正常行驶时的侧偏角阈值;
如车头方向指向道路内侧,此时的驶出状态仅需考虑单侧的车道线或道路边界约束,驶出状态的轨迹应为圆弧,该圆弧与单侧曲线应只有一个交点或者无交点,可建立如下方程组:
由(30)可得
利用道路方向角ζ进行判断:
若上述不等式联立无解,则设定驶出角速度为0,即按照直线驶出;
驶出状态已解出,可以此为初值,使用步骤S2中的非线性优化求解方法,求得驶出状态的稳态解,并选用控制器进行控制。
本发明的优点和积极效果是:
(1)本发明提出一种基于模型和控制理论、利用车辆的漂移特性,解决大侧偏角的侧滑失控问题,该方法能够控制大侧偏角的失控车辆重新回到可操控的稳定状态,而非依赖于人的经验性操作,从而提高人员和车辆的安全性。
(2)本发明利用传感器信息对当前所处路面进行建模,用一种更为简洁的二自由度描述方式对该平面进行表征,使模型表示和求解更加简单。
(3)本发明提供的方法考虑路面平面模型,在车辆漂移动力学模型中考虑重力分量的影响,建立带有重力分量的车辆漂移状态下的动力学模型,使模型更加准确;同时考虑环境的空间约束,优化求解漂移稳态,使得求解出的漂移稳态更加准确,更有利于解决实际驾驶场景下的漂移稳态求解问题。
(4)本发明提供的方法当判断车辆状态满足驶出漂移稳态的条件时,提出一种控制车辆驶出漂移稳态的方法,之后进入正常行驶状态,以便于驾驶员或者其他控制模块接管控制权,在驶出漂移稳态时,考虑道路方向和曲率,解算出适应于道路的驶出状态从而加以控制。
附图说明
图1为本发明车辆再稳定控制方法的流程图;
图2为建立路面模型的流程图;
图3为车辆坐标系与世界坐标系的示意图;
图4为轮胎力及轮胎转角的示意图;
图5为α夹角与θ夹角的示意图;
图6a为不合适的漂移稳态半径导致车辆的行驶轨迹与道路边界相交的示意图;
图6b为环境边界约束下漂移稳态半径的示意图;
图7为控制车辆驶出漂移状态的流程图;
图8为计算车头与道路相对姿态的流程图;
图9为车头方向指向道路外侧的示意图;
图10为车头方向与道路方向平行的示意图;
图11为车头方向指向道路内侧的示意图;
图12为驶出条件判断过程的流程图;
图13为驶出横摆角速度的计算流程图;
图14为本发明车辆再稳定控制方法的总体流程图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
参阅图1、图14,本发明的目的是提供一种控制失控车辆重新进入可操控状态的方法,该方法具有包括以下步骤:
第一步,获取IMU(惯性测量单元)等传感器信息,利用加速度、轮胎力等信息建立路面模型,使用θ角和α角表征当前车身与路面的相对角度关系;其中,θ为路面法向量与世界坐标系Z轴的夹角,α为车头朝向和处于地面切平面上的重力分量的夹角;
第二步,依据车辆侧偏角的大小,同时结合后轮所受到的侧向力大小,判断车辆是否处于失控状态;如果是,则考虑重力分量建立车辆的漂移动力学模型,之后以当前车辆状态为初始条件,考虑环境边界,优化求取漂移稳态;优化求取漂移稳态时,需要判断是否超出最大求解次数?如是,则提醒驾驶员介入;否则判断是否有解?如是,则判断是否超时?如否,则求得稳态的解;
第三步,利用反馈控制方法按照第二步求得的稳态解控制车辆维持漂移稳态;
第四步,获取车道信息,计算车辆与道路的相对姿态,判断是否满足驶出漂移稳态的条件;如果是,则使用驶出控制方法控制车辆脱离漂移状态,进入正常行驶状态;
第五步,判断是否满足移交车辆控制权条件;如果是,则向驾驶员或者其他自动驾驶控制模块移交控制权。
(1)路面模型
假设局部的行驶路面为平面,该路面平面相对于世界坐标系而言,有一个三维的旋转。考虑到路面的性质,我们只需考虑路面沿道路方向的坡度(slope)和垂直道路方向的倾角(bank angle)。现有方案多只考虑其中的沿道路方向的坡度进行建模,或者考虑二者,但需要使用角速度积分并多次转换坐标系等较为复杂的处理。
本发明利用传感器返回的重力加速度、车辆加速度、轮胎力等信息对路面进行建模,使用两个角度即可表征当前车身与该路面的相对角度关系;图2是本步骤的算法流程图,具体过程如下:
(1.1)获取加速度、轮胎力等信息
首先从加速度传感器获取车辆在纵向和侧向的加速度信息,从重力传感器获取重力加速度方向,利用轮胎模型或者轮胎力传感器获取到轮胎在纵向和侧向所受到的轮胎力,以及轮胎相对于车辆坐标系的转角;车辆坐标系可依据图3建立,车辆绕x轴的旋转角度为roll角,表示为φroll;车辆绕y轴的旋转角度为pitch角,表示为φpitch;
轮胎力、轮胎转角等的表示如图4;关于各符号的说明如下:
Xworld,Yworld,Zworld:世界坐标系的坐标轴
x,y,z:车辆坐标系的坐标轴
D:同一轮轴上两轮的轮心距
Lf:重心与前轮轴水平距离
Lr:重心与后轮轴水平距离
V;车辆重心处的速度
β:车辆侧偏角
δ:前轮转向角
Fijx,Fijy:车轮所受到的纵向力和侧向力,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;
车辆纵向加速度表示为ax,侧向加速度表示为ay。
(1.2)路面坡角
考虑到车辆本身的roll和pitch角,我们可以建立如下关系式:
maxcosφpitch=∑Fijx+mg sinθcosα (1)
maycosφroll=∑Fijy+mg sinθsinα (2)
其中,m为车辆质量,g为重力加速度,θ为路面法向量与世界坐标系Z轴的夹角,α为车头朝向和处于地面切平面上的重力分量的夹角,如图5所示。
由(1)和(2)可得到:
(1.3)重力分量方向
对θ进行判断,若|θ|≤θthres,则可认为当前路面为绝对平面,此时α为任意值,且对后续建模及求解没有影响,其中θthres为预先设定的阈值,为较小量。
若|θ|>θthres,α可按公式(4)求解:
α为与车头方向有关的变量,取值范围为(-π,π];而在局部范围内,θ与道路设计有关,可认为是常量,取值范围应满足道路设计指标,通常不会太大。在某一瞬时,斜坡平面相对于车辆的姿态可以被θ和α唯一确定,因此可以使用滤波算法对这两个角分别进行处理,从而使得路面平面在局部范围内更加稳定。
(2)动力学模型
通常可以依据车辆侧偏角的大小,同时结合后轮所受到的侧向力大小来判断车辆是否处于失控状态(后轮侧滑)。
假设车辆围绕车辆坐标系z轴的旋转角速度表示为则角加速度为将车头朝向和处于地面切平面上的重力分量的夹角α、车辆重心速度V、车身侧偏角β关于时间的导数分别记为和如前所述,因为在局部路面下可以认为路面为固定平面,因此重力分量的方向在局部是稳定的,因此有关系式m为车身质量,各个车轮的转速及转速关于时间的导数分别记为ωij和其中,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮。此时,可建立车辆的漂移动力学模型如下:
其中,Iz为车身绕z轴的转动惯量,Iw为车轮的转动惯量,Tij为施加在各车轮上的驱动力矩,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;rw为车轮半径,δ为前轮转角。相比于现有技术方案,本发明在动力学模型中考虑了重力分量。
对于轮胎力Fijx和Fijy,可以挑选任意一种轮胎模型建模,比如Uni-tire或者MF模型等。可表示为:
摩擦系数同样可表示为类似函数:
计算载荷转移时,同样需要考虑重力分量的影响:
两个前轮垂向力合力为
两个后轮垂向力合力为
其中,g为重力加速度,h为车辆重心离地面高度。
若假设
其中,D为同一轮轴上的两轮轮心距,由公式(12)和(13),可以计算得到四个车轮的垂向力如下:
综上,在倾斜平面上考虑载荷转移的车辆动力学模型即可建立。
(3)优化求解
当车辆处于理想的漂移稳态,如下物理量保持常量:漂移半径R、车速V、横摆角速度(车辆围绕车辆坐标系z轴的旋转角速度)车辆侧偏角β。现有求解漂移稳态的技术方案通常认为漂移场景不受空间约束,因此对漂移半径R已做提前规定。本技术方案依据环境边界求取漂移半径的取值范围,并将其作为一个优化变量,最终与其他参数同时优化。如图6(a)所示,当车辆发生侧滑,若不采取措施或者漂移稳态的半径不合适,则可能导致车辆的行驶轨迹与道路边界相交,从而引发事故;本发明的目的在于控制车辆处于一个符合环境边界约束的漂移稳态,环境边界约束主要体现在对于漂移稳态半径的限制,如图6(b)所示。
事实上,我们只需考虑单侧边界对于漂移的约束,即分如下两种情况:
-当侧滑方向为右侧时,仅需考虑右侧道路边界对于漂移的约束;
-当侧滑方向为左侧时,仅需考虑左侧道路边界对于漂移的约束。
下面以向右侧侧滑为例,假设右侧道路边界已通过视觉感知系统得到,可以表示为y边界=C0+C1x+C2x2+C3x3,该多项式曲线为道路边界在车辆坐标系中的表示。其中,点(x,y边界)为边界曲线上的点在车辆坐标系下的坐标,C0,C1,C2,C3为多项式系数。
当车辆以侧偏角β进行逆时针稳态漂移,稳态漂移轨迹可以表示为当前时刻车辆坐标系下的圆,该圆圆心(xO,yO)满足如下关系:
则该圆的方程为:
(x+R sinβ)2+(y漂移-R cosβ)2=R2 (20)
因车辆向右侧侧滑,所以x=0时,y边界一定为负,这样仅需令漂移圆满足边界条件:y漂移>y边界+d膨胀,即:
其中,d膨胀是为安全考虑而预先给定的膨胀深度。此不等式方程不易求解,可以将x在(0,R(1-sinβ)]区间离散化后,建立多个点处的不等式约束。假设将(0,R(1-sinβ)]采样N个点则可建立不等式方程组:
将当前时刻车速V、车辆侧偏角β作为稳态常量,将前述动力学模型(5)-(18)离散化,建立目标函数
如果求得了最优解,可选用一种控制方法进行控制,控制量为前轮转角δ和各车轮的驱动力矩Tij,控制方法如:MPC(Model Predictive Control)、LQR(Linear QuadraticRegulator)、BackStepping等。
对于向左侧侧滑,处理方法与此类同。
(4)驶出控制
当车辆维持漂移稳态一定时长或到达驶出位置后,即可控制车辆驶出漂移状态,进入正常行驶状态,主要流程如图7,具体步骤为:先获取车道信息,车道信息可通过视觉感知模块或者高精地图得到;之后判断是否满足驶出条件,当满足满足驶出条件时,则计算驶出状态,控制求解,应用控制量,判断是否脱离失控状态,如是,则移交控制权;如否,则继续控制求解。
(4.1)判断是否满足驶出条件
(4.1.1)计算车辆与道路的相对姿态,主要流程如流程图8所示。
首先需要获取两侧车道线或者道路边界曲线方程。假设通过感知模块感知得到的左侧车道线或者路边界在车辆坐标系中的曲线方程为y=C0L+C1Lx+C2Lx2+C3Lx3,右侧车道线或者路边界在车辆坐标系中的曲线方程为y=C0R+C1Rx+C2Rx2+C3Rx3,其中,C0L~C3L、C0R~C3R是各曲线方程的多项式系数;
之后根据道路边界曲线方程计算道路方向ζ,计算道路方向的方法是:
(1)获取加权权值:
(2)将左、右两条曲线在x=0点处的切线方向与车辆坐标系X轴的夹角分别表示为ζL和ζR,则获取两侧朝向:
(3)将当前道路相对于车辆坐标系的方向角表示为ζ,则可获取道路朝向:
ζ=pζL+qζR (26)
最后对侧滑方向进行判断,并根据计算得到的道路方向ζ判断车头指向;在对侧滑方向判断时,如是向左侧滑,则判断ζ>0?;是,则车头指向道路内侧;否,则判断ζ=0?;是,则车头与道路方向平行;否,则车头指向道路外侧;如不是向左侧滑,则判断ζ<0?;是,则车头指向道路内侧;否,则判断ζ=0?;是,则车头与道路方向平行;否,则车头指向道路外侧。
(4.1.2)判断驶出条件,主要流程如图12所示:
基于(4.1.1)图8流程中得到的车头指向(车头与道路相对姿态),需要考虑以下三种情况,以判断是否驶出:
(1)判断车头是否朝向道路外侧?如当车头方向指向道路外侧时(如图9所示),则继续进行稳态漂移控制;
(2)判断车头方向与道路方向是否平行?将道路方向角的绝对值记为|ζ|,当|ζ|在误差范围内,则可认为当前车头方向与道路方向平行(如图10所示),可根据当前道路双侧的曲线方程计算理想驶出状态并进行驶出控制(见4.2),达到驶出状态(比如S点)后移交控制权。
(3)判断稳态漂移时间是否大于阈值?如当车头方向指向道路内侧且漂移状态持续时间超过规定时间(如图11所示),则驶出状态按照道路单侧曲线方程计算并进行驶出控制,到达驶出状态(比如S点)后移交控制权。
(4.2)计算驶出状态
如(4.1.2)所述,驶出状态分两种,下面分别讨论。
(4.2.1)车头方向与道路方向平行
此时,驶出状态需要与道路方向相适应,驶出的轨迹是圆弧或者直线,具体计算流程如下:
(1)记左、右两条曲线在x=0点处的曲率为κL和κR,使用(4.1.1)节中的双侧车道线或者道路边界曲线方程计算双侧曲率:
(2)记当前道路曲率为κ,使用(4.1.1)节中的加权权值计算驶出曲率:
κ=pκL+qκR (28)
(3)驶出速度为当前车速V,计算驶出角速度:
(4)驶出侧偏角应满足|β|<βmax,其中βmax为车辆正常行驶时的侧偏角阈值。
(4.2.2)车头方向指向道路内侧
此时的驶出状态仅需考虑单侧的车道线或道路边界约束,驶出状态的轨迹应为圆弧,该圆弧与单侧曲线应只有一个交点或者无交点,可建立如下方程组:
由(30)可得
利用(4.1.1)节的道路方向角ζ进行判断:
若上述不等式联立无解,则设定驶出角速度为0,即按照直线驶出。
综上,驶出横摆角速度的计算流程如图13所示:
同样,驶出侧偏角应满足|β|<βmax,其中βmax为车辆正常行驶时的侧偏角阈值。
至此,驶出状态已解出,可以此为初值,使用类似前述非线性优化求解方法,求得驶出状态的稳态解,并选用一种控制器进行控制。
当车辆维持驶出状态时长超过阈值且判断车辆已经脱离失控状态,则向驾驶员或者其他自动驾驶控制模块移交控制权。
Claims (6)
1.一种失控车辆再稳定的控制方法,其特征在于,具体包括以下步骤:
步骤S1、获取传感器信息,利用重力加速度、车辆加速度、轮胎力信息建立路面模型,使用θ角和α角表征当前车身与路面的相对角度关系;其中,θ为路面法向量与世界坐标系Z轴的夹角,α为车头朝向和处于地面切平面上的重力分量的夹角;
步骤S2、依据车辆侧偏角的大小,同时结合后轮所受到的侧向力大小,判断车辆是否处于失控状态;如果是,则考虑重力分量建立车辆的漂移动力学模型,之后以当前车辆状态为初始条件,考虑环境边界,优化求取漂移稳态;
步骤S3、利用反馈控制方法按照步骤S2求得的稳态解控制车辆维持漂移稳态;
步骤S4、获取车道信息,计算车辆与道路的相对姿态,判断是否满足驶出漂移稳态的条件;如果是,则使用驶出控制方法控制车辆脱离漂移状态,进入正常行驶状态;
步骤S5、判断是否满足移交车辆控制权条件;如果是,则向驾驶员或者其他自动驾驶控制模块移交控制权;
其中,步骤S2中车辆的漂移动力学模型如下:
其中,车辆围绕车辆坐标系z轴的旋转角速度表示为则角加速度为车头朝向和处于地面切平面上的重力分量的夹角α、车辆重心速度V、车身侧偏角β关于时间的导数分别记为和各个车轮的转速及转速关于时间的导数分别记为ωij和i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;Iz为车身绕车辆坐标系z轴的转动惯量,Iw为车轮的转动惯量,Tij为施加在各车轮上的驱动力矩,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;rw为车轮半径;δ为前轮转角;β为车辆侧偏角;D为同一轮轴上两轮的轮心距;Lf为重心与前轮轴水平距离;Lr为重心与后轮轴水平距离;
对于轮胎力Fijx和Fijy,表示为:
摩擦系数同样表示为类似函数:
计算载荷转移时,同样需要考虑重力分量的影响:
两个前轮垂向力合力为
两个后轮垂向力合力为
其中,h为车辆重心离地面高度;
若假设
由公式(12)和(13),计算得到四个车轮的垂向力如下:
综上,在倾斜平面上考虑载荷转移的车辆的漂移动力学模型即被建立。
2.根据权利要求1所述的失控车辆再稳定的控制方法,其特征在于,步骤S1中θ角和α角的计算过程如下:
考虑到车辆本身的roll和pitch角,建立如下关系式:
maxcosφpitch=∑Fijx+mgsinθcosα (1)
maycosφroll=∑Fijy+mgsinθsinα (2)
其中,m为车辆质量,g为重力加速度,θ为路面法向量与世界坐标系Z轴的夹角,α为车头朝向和处于地面切平面上的重力分量的夹角,φroll为车辆绕车辆坐标系x轴的旋转角度,φpitch为车辆绕车辆坐标系y轴的旋转角度,Fijx,Fijy为车轮所受到的纵向力和侧向力,i∈{F,R},F表示前轮,R表示后轮,j∈{R,L},R表示右轮,L表示左轮;ax为车辆纵向加速度,ay为车辆侧向加速度;
由(1)和(2)得到:
对θ进行判断,若|θ|≤θthres,则认为当前路面为绝对平面,此时α为任意值,其中θthres为预先设定的阈值;
若|θ|>θthres,α按公式(4)求解:
α为与车头方向有关的变量,取值范围为(-π,π],在局部范围内,θ与道路设计有关,认为是常量,取值范围应满足道路设计指标。
3.根据权利要求1所述的失控车辆再稳定的控制方法,其特征在于,步骤S2中优化求解漂移稳态时,只需考虑单侧边界对于漂移的约束,以向右侧侧滑为例,优化求解漂移稳态的过程如下:
假设右侧道路边界已通过视觉感知系统得到,表示为y边界=C0+C1x+C2x2+C3x3,该多项式曲线为道路边界在车辆坐标系中的表示;其中,点(x,y边界)为边界曲线上的点在车辆坐标系下的坐标,C0,C1,C2,C3为多项式系数;
当车辆以侧偏角β进行逆时针稳态漂移,稳态漂移轨迹表示为当前时刻车辆坐标系下的圆,该圆圆心(xO,yO)满足如下关系:
则该圆的方程为:
(x+Rsinβ)2+(y漂移-Rcosβ)2=R2 (20)
因车辆向右侧侧滑,所以x=0时,y边界一定为负,这样仅需令漂移圆满足边界条件:y漂移>y边界+d膨胀,即:
其中,d膨胀是为安全考虑而预先给定的膨胀深度;此不等式方程不易求解,将x在(0,R(1-sinβ)]区间离散化后,建立多个点处的不等式约束;假设将(0,R(1-sinβ)]采样N个点则建立不等式方程组:
将当前时刻车速V、车辆侧偏角β作为稳态常量,将动力学模型(5)-(18)离散化,建立目标函数
4.根据权利要求1所述的失控车辆再稳定的控制方法,其特征在于,步骤S4中计算车辆与道路的相对姿态的过程如下:
首先需要获取两侧车道线或者道路边界曲线方程,假设通过感知模块感知得到的左侧车道线或者路边界在车辆坐标系中的曲线方程为y=C0L+C1Lx+C2Lx2+C3Lx3,右侧车道线或者路边界在车辆坐标系中的曲线方程为y=C0R+C1Rx+C2Rx2+C3Rx3,其中,C0L~C3L、C0R~C3R是各曲线方程的多项式系数;
之后根据道路边界曲线方程计算道路方向ζ,计算道路方向的方法是:
(1)获取加权权值:
(2)将左、右两条曲线在x=0点处的切线方向与车辆坐标系X轴的夹角分别表示为ζL和ζR,则获取两侧朝向:
(3)将当前道路相对于车辆坐标系的方向角表示为ζ,则获取道路朝向:
ζ=pζL+qζR (26)
最后对侧滑方向进行判断,并根据计算得到的道路方向ζ判断车头指向;在对侧滑方向判断时,如是向左侧滑,则判断ζ>0?;是,则车头指向道路内侧;否,则判断ζ=0?;是,则车头与道路方向平行;否,则车头指向道路外侧;如不是向左侧滑,则判断ζ<0?;是,则车头指向道路内侧;否,则判断ζ=0?;是,则车头与道路方向平行;否,则车头指向道路外侧。
5.根据权利要求4所述的失控车辆再稳定的控制方法,其特征在于,步骤S4中驶出漂移稳态的判断过程如下:
基于得到的车头指向,需要考虑以下三种情况,以判断是否驶出:
(1)判断车头是否朝向道路外侧?如当车头方向指向道路外侧时,则继续进行稳态漂移控制;
(2)判断车头方向与道路方向是否平行?将道路方向角的绝对值记为|ζ|,当|ζ|在误差范围内,则认为当前车头方向与道路方向平行,根据当前道路双侧的曲线方程计算理想驶出状态并进行驶出控制;
(3)判断稳态漂移时间是否大于阈值?如当车头方向指向道路内侧且漂移状态持续时间超过规定时间,则驶出状态按照道路单侧曲线方程计算并进行驶出控制。
6.根据权利要求5所述的失控车辆再稳定的控制方法,其特征在于,步骤S4中驶出控制方法的具体控制过程如下:
确定驶出状态,如车头方向与道路方向平行,此时,驶出状态需要与道路方向相适应,驶出的轨迹是圆弧或者直线,具体计算流程如下:
(1)记左、右两条曲线在x=0点处的曲率为κL和κR,使用双侧车道线或者道路边界曲线方程计算双侧曲率:
(2)记当前道路曲率为κ,使用加权权值计算驶出曲率:
κ=qκL+qκR (28)
(3)驶出速度为当前车速V,计算驶出角速度:
(4)驶出侧偏角应满足|β|<βmax,其中βmax为车辆正常行驶时的侧偏角阈值;
如车头方向指向道路内侧,此时的驶出状态仅需考虑单侧的车道线或道路边界约束,驶出状态的轨迹应为圆弧,该圆弧与单侧曲线应只有一个交点或者无交点,建立如下方程组:
由(30)得
利用道路方向角ζ进行判断:
若上述不等式联立无解,则设定驶出角速度为0,即按照直线驶出;
驶出状态已解出,以此为初值,使用步骤S2中的非线性优化求解方法,求得驶出状态的稳态解,并选用控制器进行控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110650218.1A CN113401112B (zh) | 2021-06-10 | 2021-06-10 | 一种失控车辆再稳定的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110650218.1A CN113401112B (zh) | 2021-06-10 | 2021-06-10 | 一种失控车辆再稳定的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113401112A CN113401112A (zh) | 2021-09-17 |
CN113401112B true CN113401112B (zh) | 2022-08-12 |
Family
ID=77683633
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110650218.1A Active CN113401112B (zh) | 2021-06-10 | 2021-06-10 | 一种失控车辆再稳定的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113401112B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113895437B (zh) * | 2021-10-28 | 2023-03-07 | 浙江大学 | 一种基于lqr最优控制的车辆自主漂移控制方法 |
CN113919082B (zh) * | 2021-12-14 | 2022-03-15 | 成都运达科技股份有限公司 | 一种列车纵向动力学建模方法及系统 |
CN114572231B (zh) * | 2022-03-14 | 2024-09-17 | 中国第一汽车股份有限公司 | 紧急避障工况下车辆漂移运动的质心侧偏角规划方法、装置、车辆和计算机可读存储介质 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4161923B2 (ja) * | 2004-03-09 | 2008-10-08 | 株式会社デンソー | 車両安定化制御システム |
KR102530684B1 (ko) * | 2018-05-04 | 2023-05-11 | 현대자동차주식회사 | 차량의 드리프트 주행 상태 구현 제어 방법 |
CN108909703B (zh) * | 2018-06-27 | 2020-05-12 | 聊城大学 | 一种自动驾驶紧急避让的失稳可控域的判定方法 |
CN112051851B (zh) * | 2020-09-09 | 2022-03-01 | 清华大学 | 极限工况下电动四驱车辆的自主漂移控制方法及系统 |
-
2021
- 2021-06-10 CN CN202110650218.1A patent/CN113401112B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113401112A (zh) | 2021-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113401112B (zh) | 一种失控车辆再稳定的控制方法 | |
CN110377039B (zh) | 一种车辆避障轨迹规划与跟踪控制方法 | |
JP7492530B2 (ja) | 自動車両のホイール操舵システムおよび差動ブレーキシステムの組合せ制御のための設定値を生成する方法 | |
hwan Jeon et al. | Optimal motion planning with the half-car dynamical model for autonomous high-speed driving | |
CN109969183A (zh) | 基于安全可控域的弯道跟车控制方法 | |
KR100939039B1 (ko) | 차량의 제어장치 | |
CN113246974B (zh) | 无人驾驶应急场景下避险/降损控制方法、存储介质和电子装置 | |
CN111267835B (zh) | 基于模型预测算法的四轮独立驱动汽车稳定性控制方法 | |
CN111959500B (zh) | 一种基于轮胎力分配的汽车路径跟踪性能提升方法 | |
CN107085424A (zh) | 用于自动驾驶的预瞄横向控制 | |
WO2006013922A1 (ja) | 車両の制御装置 | |
Subosits et al. | Autonomous vehicle control for emergency maneuvers: The effect of topography | |
Kim et al. | Drive control algorithm for an independent 8 in-wheel motor drive vehicle | |
WO2022266824A1 (zh) | 一种转向控制方法及装置 | |
JP2003231429A (ja) | 車両の中心対称面の両側での荷重移動を考慮した横方向力の測定値による車両の軌道へのアクション | |
Németh et al. | Design of actuator interventions in the trajectory tracking for road vehicles | |
Kone | Lateral and longitudinal control of an autonomous racing vehicle. | |
CN117270386A (zh) | 基于耦合自抗扰的分布式驱动六轮转向车辆同相位转向控制方法及控制器 | |
CN113396093A (zh) | 用于自主控制设备移动性的方法 | |
CN114435399B (zh) | 基于预测模型的自动驾驶汽车稳定性路径跟踪方法 | |
CN115837843A (zh) | 一种分布式驱动电动汽车直接横摆力矩协调转向控制方法 | |
Chaichaowarat et al. | Dynamics and simulation of RWD vehicles drifting at steady state using BNP-MNC tire model | |
CN113895437B (zh) | 一种基于lqr最优控制的车辆自主漂移控制方法 | |
CN114954432A (zh) | 一种车辆路径跟踪与车身姿态协同控制方法 | |
CN112590774B (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 |