CN111845755B - 一种车辆纵向车速估计方法 - Google Patents
一种车辆纵向车速估计方法 Download PDFInfo
- Publication number
- CN111845755B CN111845755B CN202010520884.9A CN202010520884A CN111845755B CN 111845755 B CN111845755 B CN 111845755B CN 202010520884 A CN202010520884 A CN 202010520884A CN 111845755 B CN111845755 B CN 111845755B
- Authority
- CN
- China
- Prior art keywords
- wheel
- vehicle
- longitudinal
- acceleration
- speed
- 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 85
- 230000001133 acceleration Effects 0.000 claims abstract description 128
- 238000004422 calculation algorithm Methods 0.000 claims description 34
- 238000012937 correction Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 10
- 238000001914 filtration Methods 0.000 claims description 9
- 238000005096 rolling process Methods 0.000 claims description 8
- 238000005070 sampling Methods 0.000 claims description 7
- 230000009467 reduction Effects 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 238000001514 detection method Methods 0.000 claims description 5
- 239000013598 vector Substances 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 4
- 230000008859 change Effects 0.000 description 9
- 238000005259 measurement Methods 0.000 description 8
- 238000004088 simulation Methods 0.000 description 6
- 238000012360 testing method Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 230000009194 climbing Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 210000001503 joint Anatomy 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000004043 responsiveness Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012795 verification 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
- 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/06—Road conditions
- B60W40/076—Slope angle of the road
-
- 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
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种车辆纵向车速估计方法,所述方法包括:计算各车轮的等效车轮转动角加速度;计算相应车轮的实际车轮转动角加速度;将等效车轮转动角加速度和对应车轮的实际车轮转动角加速度的偏差、车轮滑转/滑移率作为车轮失稳判定依据,确定车辆实时失稳车轮数量和组合情况;根据车辆实时失稳车轮数量和组合情况进行纵向车速计算;计算道路坡度角;根据道路坡度角对所计算的纵向车速进行校正。本发明能够提高车辆参数估计的工况适应性。
Description
技术领域
本发明涉及一种车辆纵向车速估计方法,属于车辆控制技术领域。
背景技术
越野车辆在军事机动、抢险救灾等领域发挥着重要作用,而分布式驱动的轮毂电机车辆又是近年来新能源汽车研究热点,其独特的驱动特点可以更好的使车辆适应于越野工况。但由于越野工况具有路面起伏、附着条件多变、高噪声的特点,这也增加了车辆于越野道路的控制难度。对车辆进行纵向车速与道路坡度参数的获取是车辆动力学控制的基础,对参数估计的精度以及实时性问题将直接影响控制效果。
对于车辆纵向车速的估计方法主要分为两类:运动学方法和动力学方法。运动学方法具有较好的估计实时性,应用相对广泛,但车辆非线性特征、传感器测量噪声及误差等对估计精度有较大影响,单一估计算法对复杂多变的越野工况适应性较差;动力学方法依赖于高精度的车辆动力学模型及轮胎模型,其高精度和较好的滤波性能以较大的计算量为代价,实时性一般,同时对于纵向驱动力估计和实时噪声获取有较高要求,对于高噪声的越野工况难以保证。
对于道路坡度的估计主要分为:运动学方法、动力学方法以及运动学于动力学相结合的估计方法。运动学方法往往基于传感器测量原理采用多传感器融合滤波的方法进行道路坡度估计,实时性较好,但其估计精度受传感器静态偏差、噪声估计影响,在越野工况下适应性较差;动力学方法基于车辆纵向动力学模型进行估计,其估计精度与模型精度及整车质量相关,适用于整车质量变化较小的车辆;运动学与动力学结合的方法,对运动学及动力学方法的误差频率进行分析,采用各自精度较高频段信息融合估计,估计精度较高,但其固定频段进行融合的方法对于噪声多变的工况适应性仍有待研究。
发明内容
本发明的目的在于克服现有技术中的不足,提供一种车辆纵向车速估计方法,能够提高车辆参数估计的工况适应性。
为达到上述目的,本发明是采用下述技术方案实现的:
一种车辆纵向车速估计方法,所述方法包括如下步骤:
计算各车轮的等效车轮转动角加速度;
计算相应车轮的实际车轮转动角加速度;
将等效车轮转动角加速度和对应车轮的实际车轮转动角加速度的偏差、车轮滑转/滑移率作为车轮失稳判定依据,确定车辆实时失稳车轮数量和组合情况;
根据车辆实时失稳车轮数量和组合情况进行纵向车速计算;
自适应估计道路坡度角;
根据道路坡度角对所计算的纵向车速进行校正。
进一步地,所述等效车轮转动角加速度采用下述方法计算获取:
式中,ao、均为向量,为等效车轮轮心加速度,i=1,2,3,4,分别表示左前轮、右前轮、左后轮、右后轮;ao为车辆质心加速度,为车轮绕车辆质心转动的切向加速度,为车轮绕车辆质心转动的法向加速度;γ为车辆横摆角速度;B为轮距;a为车辆前轴至车辆质心距离;b为车辆后轴至车辆质心距离;
等效车轮转动角加速度如下:
进一步地,所述实际车轮转动角加速度采用下述公式计算获取:
进一步地,车轮失稳的判定方法包括:
式中,为基于上一时刻纵向车速估计值的车辆滑转/滑移率估计值;sx_set为滑转率门限值;上一时刻纵向车速估计值;为车轮转动线速度在x轴上的分量,r为车轮有效滚动半径;γ为车辆横摆角速度;B为轮距;δ为车轮转角;ωi为实际车轮转动角速度,可通过旋变信号检测换算得到。
进一步地,根据车辆实时失稳车轮数量和组合情况进行纵向车速计算的方法包括如下步骤:
1)无车轮失稳时,采用平均轮速算法进行纵向车速计算:
2)单轮失稳时,制动工况下采用最大轮速法进行纵向车速计算,驱动工况下最小轮速法进行纵向车速计算:
其中,Pbra为制动踏板开度;
3)异侧两车轮失稳时,对两个未失稳车轮纵向轮速取平均值作为纵向车速,如下式:
其中,n为处于稳定状态车轮数量;vi为处于稳定状态车轮的纵向换算车速;i表示处于稳定状态的车轮序号,i=1,2,3,4;
4)同侧两车轮失稳时,对两个未失稳车轮纵向轮速取平均值后再基于横摆角速度对车辆纵向车速进行修正:
5)多轮失稳时,采用纵向加速度积分算法计算纵向车速估计值,如下式:
采用纵向车速估计值与各轮轮速偏差值作为该模式下纵向车速估计校正项,表示如下:
综上,多轮失稳时,车辆纵向车速估计算法如下:
进一步地,在纵向车速计算中,在算法切换处采用低通滤波处理,纵向车速如下式所示:
进一步地,采用自适应变遗忘因子最小二乘法进行道路坡度角估计。
进一步地,根据道路坡度角采用下述公式对所计算的纵向车速进行校正:
与现有技术相比,本发明所达到的有益效果:
通过纵向车速估计值,对道路坡度值进行了估计,并基于此道路坡度值,对纵向车速估计的输入参数(车辆纵向加速度)进行了修正,形成闭环的反馈系统,有效提高了估计方法的适应性和鲁棒性,为车辆于越野工况的动力学控制提供基础。
附图说明
图1为本发明实施例提供的车辆纵向车速估计方法的总体流程图;
图2为本发明实施例提供的车辆纵向车速估计方法的详细流程图;
图3为60%纵坡车速估计离线仿真数据图;
图4为60%纵坡坡度估计离线仿真数据图;
图5为对接路面加速联合估计离线仿真数据图。
具体实施方式
下面结合附图对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
如图1、图2所示,是本发明实施例提供的车辆纵向车速估计方法的总体流程图,包括以下步骤:
步骤S1、基于越野工况的四轮毂电机驱动车辆纵向车速估计:
以车载传感器、陀螺仪等设备获取车辆运动状态信息为基础,根据质心加速度进行等效车轮转动加速度估计,基于车轮是否滑移进行车轮稳定性判断,基于实时失稳车轮数量及组合情况进行纵向车速估计,对得到的车速进行低通滤波优化处理;
步骤1.1、针对越野工况的车速估计以车辆运动状态参数的获取为基础,包括驾驶员输入(加速踏板开度、制动踏板开度、档位信号),陀螺仪测量的车辆运动状态信息(横/纵向加速度、横摆角速度),以及轮毂电机旋变装置测量的等效轮速信号,进而对车轮转动加速度进行估计。
步骤1.2、基于质心加速度的等效车轮转动加速度估计:由于车辆在越野工况行驶中,车轮可能存在不同程度的滑转/滑移运动,因此,其转动线速度不能直接等效计算为车辆质心速度,但是车辆质心与车轮轮心在俯视平面内的几何关系固定,通过传感器测量所获取的质心加速度能够通过分析计算,在一定程度上等效为车轮轮心的加速度,进而计算等效车轮转动加速度,并基于此值与轮速传感器微分计算的实际车轮转动加速度进行比较,以此作为车轮稳定性判断依据之一。具体包括如下步骤:
根据车辆运动学模型,假设车辆行驶车轮无滑转/滑移,且车轮无侧偏现象,整车视为刚体,四轮轮心与车辆质心具有固定的几何关系。该工况下,可运用基点法通过实际测得的质心加速度计算等效车轮转动加速度。车辆质心加速度ao大小可由车载加速度传感器测得的纵向加速度ax和横向加速度ay计算得到:
由于该越野车辆常用工况为中低速工况,车辆质心横向加速度相对于质心纵向加速度较小,不考虑轮胎的侧偏特性,因此,质心加速度侧偏角可以忽略,等效车轮轮心加速度可表示为:
式中,ao、均为向量,为等效车轮轮心加速度,i=1,2,3,4,分别表示左前轮、右前轮、左后轮、右后轮,其余同理;为车轮绕车辆质心转动的切向加速度,为车轮绕车辆质心转动的法向加速度;γ为车辆横摆角速度;B为轮距。
等效车轮转动角加速度如下:
根据轮毂电机旋变测得的转速信号计算实际车轮转动角加速度为:
步骤1.3、车轮稳定性判断:依据车轮是否滑转或滑移,对各个车轮进行稳定性判断。各个车轮的等效车轮转动角加速度是基于车辆质心运动状态参数转换计算得到的稳定时车轮运动状态参数,而通过电机转速信号计算得到的实际车轮转动角加速度为车轮的实际状态参数,因此,将上述两个参数差异作为一个稳定性判定条件。同时,为了提高判断结果的可靠性,将基于上一时刻估计车速计算得到的车轮滑转/滑移率作为另一个稳定性判定条件。当某车轮运动状态满足上述两条判定条件中的任意一条时,认为该车轮发生滑转或滑移,判定该车轮失稳,其轮速测量值对于纵向车速估计失真。具体包括如下步骤:
车轮稳定性判定条件如下:当某车轮运动状态满足步骤1.3前述两条判定条件中的任意一条时,认为该车轮发生滑转或滑移,判定该车轮失稳,其轮速测量值对于纵向车速估计失真,不参与后续纵向车速估计过程;此外,当该车轮处于驱动防滑控制状态时,其不参与纵向车速估计。即:
或
式中,为实际车轮转动角加速度;为等效车轮转动角加速度;为车轮转动加速度偏差门限值;为车轮转动线速度在x轴上的分量(i=3、4时,δ=0;i=1、3时,第二项取负号,否则取正号);上一时刻纵向车速估计值,为基于上一时刻纵向车速估计值的车辆滑转/滑移率估计值;sx_set为滑转率门限值;δ为车轮转角;Pbra为制动踏板开度;ωi为实际车轮转动角速度,可通过旋变信号检测换算得到。
步骤1.4、基于实时失稳车轮数量及组合情况的纵向车速估计:分为无车轮失稳、单轮失稳、异侧双车轮失稳、同侧双车轮失稳以及多轮失稳五种失稳车轮组合情况,对于每一种情况,分别采取不同的车速估计方法。具体为:
根据实时的失稳车轮数量及组合状况,采用相应的纵向车速算法:
1)无车轮失稳时,采用平均轮速法,可以较好的保证转向工况下的纵向车速估计准确性:
2)单轮失稳时,车辆及车轮运动状态相对稳定,此时采用最大轮速法(制动工况)或最小轮速法(驱动工况),失稳车轮轮速测量值可剔除,从而保证纵向车速估计的准确性;此外,由于计算量小,可以保证估计的实时性。此时:
3)异侧两车轮失稳时,对两个未失稳车轮纵向轮速取平均值作为纵向车速估计值,如下式:
式中,n为处于稳定状态车轮数量;
4)同侧两车轮失稳时,对两个未失稳车轮纵向轮速取平均值后再基于横摆角速度对车辆纵向车速进行修正:
5)多轮失稳时,车轮轮速信号对于纵向车速估计而言失真严重,因此需要采用纵向加速度积分算法进行车速估计,计算如下式:
式中,ax,m为传感器测得的纵向加速度值。
由于在越野工况长时间对传感器测得的纵向加速度进行积分计算极易导致车速估计值严重失真,因此,本文采用纵向车速估计值与各轮轮速偏差值作为该模式下车速估计校正项,表示如下:
综上,多轮失稳时,车辆纵向车速估计算法如下:
步骤1.5、低通滤波优化处理:为防止工况变化过程中,车速估计算法切换造成车速估计值突变,因此在算法切换处采用低通滤波处理。即车速切换标识符上升沿或下降沿处,纵向车速估计值表示如下:
S2、基于纵向车速估计值的道路坡度估计:
道路坡度也是轮毂电机驱动越野车辆在进行动力学控制时所必需的参数,而越野工况道路坡度是时变的,并且其变化率及极值较普通工况大,对于坡度估计的实时性要求更高,因此需用易于实现、计算量相对较小、追踪效果好的最小二乘法进行坡度估计。具体包括如下步骤:
由于越野车通过纵坡时往往转向角较小,车速为中低速,车辆的横向速度及横摆角速度相对较小,因此,忽略较小的车轮侧向力,此时纵向动力学方程为:
将上式改写为系统状态方程:
y=u+b;
式中,Fxi(i=1,2,3,4)分别为左前、右前、左后、右后驱动轮的纵向驱动力,Fi为坡度阻力;Ff为车辆行驶阻力,f表示滚动阻力系数,g表示地球重力加速度;为道路坡度角,Cd为空气阻力系数,A为车辆迎风面积,ρ为空气密度,m为车辆质量;y为整车纵向驱动力,u为质量和速度的函数,b为整车质量和坡度角的函数,
由于越野工况道路坡度变化率及极值较普通工况大,对于坡度估计的实时性要求更高,因此采用易于实现、计算量相对较小、追踪效果好的最小二乘法进行坡度估计。引入遗忘因子可以降低历史数据的权重,使估计值较快收敛,从而避免“数据饱和”现象。而采用自适应变遗忘因子最小二乘法(AFFRLS),估计过程中基于系统状态调节遗忘因子,改变历史数据和新数据在估计中的权重,达到快速收敛、稳定跟踪的坡度估计效果。
式中,λ为遗忘因子,且λ∈[0,1];k表示当前采样时刻;y(i)为第i个采样时刻车辆的纵向力矩阵;u(i)为第i个采样时刻车辆质量和速度的函数值;为第i个采样时刻车辆整车质量和坡度角的函数值。遗忘因子越大,估计过程中历史数据比重越大,估计精度越高,但是会导致收敛速度变慢。遗忘因子过小,识别精度下降,但是收敛速度会提高。
最小二乘增益L(k)计算:
误差协方差P(k)更新方程:
由于车辆在坡度变化率较大工况下,各轮载荷变化引起的滚动半径、轮胎特性的非线性变化较大,其基于车轮旋转动力学估计的纵向驱动力误差增大的原理,设遗忘因子的初值为λ0,根据纵向驱动力的预测误差来设计自适应遗忘因子。观测向量纵向力的预测误差和预测误差的方差分别为:
当预测误差的方差超过事先设定的阈值ep,set时,认为坡度变化率较大,需要提高估计收敛速度,立刻减少遗忘因子至λset,之后随着样本数据的增加再慢慢增大遗忘因子,降低估计值对噪声的敏感性,提高估计精度。实际的遗忘因子计算公式为:
式中:λset为该系统的遗忘因子最小阈值;kλ为遗忘因子调节度。
步骤S3、基于运动学的纵向加速度修正:车辆纵向车速估计算法在车轮稳定性判断和复杂工况下的车辆纵向加速度积分估计算法均依赖于车辆的纵向加速度,而由车载加速度传感器测得的车辆纵向加速度包含了路面的坡度信息,且具有环境噪声,会影响纵向车速估计时车轮稳定性判断的准确性,越野工况下长时间的纵向加速度积分会导致纵向车速估计值严重失真。因此,有必要对通过传感器测得的纵向加速度进行坡度自适应修正。
所述步骤S3具体为:
基于车载加速度传感器的惯性测量原理,车辆在纵坡上行驶时,车辆同加速度传感器内置质量块都会受到自身重力沿坡道方向(车辆纵向)的分力,因此,加速度传感器测得的纵向加速度值包含车辆行驶加速度和重力加速度g在坡道方向(车辆纵向)的分量,关系如下:
本发明需要涉及纵向车速估计计算,车身姿态信息测量装置采用动态倾角传感器(陀螺仪),本实施例动态倾角传感器型号为SST810。本发明涉及轮毂电机转速的实时检测,检测方法是依据电机旋变信号对电机实时转速进行计算。本实施例中整车控制器采用32位单片机。
利用实车试验验证了本发明的控制效果,选取坡度为60%爬坡试验及对接路面加速实车试验,采集轮毂电机转矩转速数据、车辆俯仰角、车辆纵向速度及加速度等信息,利用实车试验数据进行离线仿真对比试验。
(1)60%爬坡离线仿真:
根据图3中60%纵坡车速估计离线仿真数据图,由于附着条件较好,爬坡过程中并未发生较为严重滑转,主要对坡度估计算法进行验证。图3(a)为纵向车速估计值与GPS测量值对比,可发现整体上纵向车速估计响应性和适应性较好,在各个坡度段偏差均较小;55-70s时道路坡度最大,车轮滑转率小幅增大,但未达到车轮滑转失稳判断条件,因此采用平均轮速法估计,估计车速略大于实际车速,但偏差较小,最大估计误差为1.5km/h。
根据图4中60%纵坡(角度在31°左右)实验坡度估计数据图,图4(a)实测参考值为外挂高精度陀螺仪测得实时车辆俯仰角,爬坡时受悬架影响,其测量值稍大于实际坡度值;与含纵向驱动力估计噪声和误差的估计值相比,本发明提出的AFFRLS估计方法滤波明显、精度提高,估计准确性和响应性均介于采用固定遗忘因子(0.95、0.75)估计方法;图4(c)(d)在48-62s和72-77s的坡度变化较大的过渡段遗忘因子在0.75-0.95间变化,发挥了小遗忘因子系统收敛快的特点,改善了估计的实时性,同时可变遗忘因子在一定程度保证了估计精度,估计绝对误差不超过15%,使其估计精度优于采用0.75遗忘因子估计方法;在45-48s、62-72s和77-85s的坡度变化较小的稳定段,发挥了大遗忘因子估计准确的特点,保证了稳态估计精度,估计绝对误差不超过2%,收敛时间为2s左右。
(2)对接路面加速离线仿真:,
车辆由高附路面驶入低附路面(附着系数:高附0.8,低附0.2),由于试验场地为平整的对接路面,整个实验过程中坡度变化较小,因此,以车速估计算法验证为主。
图5(a)(b),在13s时由高附路面驶入低附路面,本发明提出的自适应多模纵向车速估计方法迅速准确的判断失稳车轮并切换估计算法,两前轮滑转失稳时估计算法由四轮平均轮速法切换为异侧非失稳车轮轮速平均估计法,14s时四轮滑转失稳采用改进的加速度积分法;直到20s左右时加速结束,车轮陆续恢复稳定,估计算法迅速切换,证明本文提出的车轮稳定性判定策略具有较好的响应性和工况适应性;图5(a)(c)整个过程中纵向车速估计算法误差较小不超过5km/h,估计误差在5%以内,证明提出的估计算法合理对应不同工况,切换逻辑有效,整体上估计算法具有工况适应性,多轮滑转时的改进加速度积分车速估计法具有较好噪声抑制鲁棒性和估计精度。
图5(d)为水平对接路面加速时的道路坡度估计值,11s时车辆起步加速,由于加速过程中车辆的非线性特征更加明显,以及车轮转速及车辆速度的变化会滞后于电机转矩的输出,因此,急加速时车轮纵向驱动力误差较大,与之相比本发明提出的估计算法滤波明显,误差小于2°,对于车速波动及纵向力估计误差具有较好的鲁棒性。
本发明能够适应实际变附着、低附着、大角度纵坡及其组合工况,具有良好的工况适应性;车速估计算法能车轮稳定性判定准确、实时性好,能够较好的发挥各算法在不同工况下的优势,鲁棒性强;AFFRLS坡度估计算法遗忘因子自适应调节逻辑合理,能够改善大坡度变化率工况下的估计实时性,并保证一定估计精度,而稳定坡度下,估计精度高。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (7)
1.一种车辆纵向车速估计方法,其特征在于,所述方法包括如下步骤:
计算各车轮的等效车轮转动角加速度;
计算相应车轮的实际车轮转动角加速度;
将等效车轮转动角加速度和对应车轮的实际车轮转动角加速度的偏差、车轮滑转/滑移率作为车轮失稳判定依据,确定车辆实时失稳车轮数量和组合情况;
根据车辆实时失稳车轮数量和组合情况进行纵向车速计算;
自适应估计道路坡度角;
根据道路坡度角对所计算的纵向车速进行校正;
其中,车轮失稳的判定方法包括:
2.根据权利要求1所述的车辆纵向车速估计方法,其特征在于,所述等效车轮转动角加速度采用下述方法计算获取:
式中,ao、均为向量,为等效车轮轮心加速度,i=1,2,3,4,分别表示左前轮、右前轮、左后轮、右后轮;ao为车辆质心加速度,为车轮绕车辆质心转动的切向加速度,为车轮绕车辆质心转动的法向加速度;γ为车辆横摆角速度;B为轮距;a为车辆前轴至车辆质心距离;b为车辆后轴至车辆质心距离;
等效车轮转动角加速度如下:
4.根据权利要求1所述的车辆纵向车速估计方法,其特征在于,根据车辆实时失稳车轮数量和组合情况进行纵向车速计算的方法包括如下步骤:
1)无车轮失稳时,采用平均轮速算法进行纵向车速计算:
2)单轮失稳时,制动工况下采用最大轮速法进行纵向车速计算,驱动工况下最小轮速法进行纵向车速计算:
其中,Pbra为制动踏板开度;
3)异侧两车轮失稳时,对两个未失稳车轮纵向轮速取平均值作为纵向车速如下式:
其中,n为处于稳定状态车轮数量;vi为处于稳定状态车轮的纵向换算车速;i表示处于稳定状态的车轮序号,i=1,2,3,4;
4)同侧两车轮失稳时,对两个未失稳车轮纵向轮速取平均值后再基于横摆角速度对车辆纵向车速进行修正:
5)多轮失稳时,采用纵向加速度积分算法计算纵向车速估计值,如下式:
采用纵向车速估计值与各轮轮速偏差值作为多轮失稳模式下纵向车速估计校正项,表示如下:
综上,多轮失稳时,车辆纵向车速估计算法如下:
6.根据权利要求1所述的车辆纵向车速估计方法,其特征在于,采用自适应变遗忘因子最小二乘法进行道路坡度角估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010520884.9A CN111845755B (zh) | 2020-06-10 | 2020-06-10 | 一种车辆纵向车速估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010520884.9A CN111845755B (zh) | 2020-06-10 | 2020-06-10 | 一种车辆纵向车速估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111845755A CN111845755A (zh) | 2020-10-30 |
CN111845755B true CN111845755B (zh) | 2022-01-07 |
Family
ID=72987117
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010520884.9A Active CN111845755B (zh) | 2020-06-10 | 2020-06-10 | 一种车辆纵向车速估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111845755B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112660129B (zh) * | 2020-12-21 | 2022-05-17 | 浙江天尚元科技有限公司 | 一种智能线控底盘加速度控制系统与控制方法 |
CN114435377B (zh) * | 2022-02-25 | 2024-05-24 | 广汽埃安新能源汽车有限公司 | 一种参考车速的获取方法、装置、电子设备和存储介质 |
CN116039648B (zh) * | 2023-04-03 | 2023-06-27 | 成都赛力斯科技有限公司 | 一种基于权重的坡度计算方法、装置及车辆 |
CN117783572A (zh) * | 2023-12-20 | 2024-03-29 | 苏州承泰科技有限公司 | 一种适用于多场景的自车速度估测方法、系统及平台 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102009654B (zh) * | 2010-11-12 | 2013-02-13 | 清华大学 | 一种全轮电驱动车辆的纵向车速估计方法 |
CN106394561B (zh) * | 2015-11-10 | 2018-07-27 | 北京中科易电信息科技股份有限公司 | 一种车辆的纵向车速的估计方法和装置 |
CN109515445B (zh) * | 2018-11-23 | 2020-05-19 | 安徽猎豹汽车有限公司 | 一种用于全轮独立驱动车辆的纵向车速估计方法及其装置 |
CN109910851B (zh) * | 2019-02-19 | 2021-06-04 | 同济大学 | 基于iehb的滑移率与加速度联合的防抱死控制方法及系统 |
CN109910905B (zh) * | 2019-03-01 | 2020-07-28 | 同济大学 | 基于坡度估计修正的分布式驱动汽车多工况车速估计方法 |
CN110095635B (zh) * | 2019-05-08 | 2021-06-04 | 吉林大学 | 一种全轮驱动车辆的纵向车速估计方法 |
CN110304070A (zh) * | 2019-05-30 | 2019-10-08 | 成都九鼎科技(集团)有限公司 | 一种分布式独立驱动汽车纵向车速估计方法 |
CN110539646A (zh) * | 2019-08-06 | 2019-12-06 | 清华大学 | 一种用于全驱电动轮汽车的纵向车速估计方法及系统 |
-
2020
- 2020-06-10 CN CN202010520884.9A patent/CN111845755B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111845755A (zh) | 2020-10-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111845755B (zh) | 一种车辆纵向车速估计方法 | |
CN107161207B (zh) | 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法 | |
CN108128308B (zh) | 一种分布式驱动电动汽车的车辆状态估计系统及方法 | |
US6745112B2 (en) | Method of estimating quantities that represent state of vehicle | |
CN108819950B (zh) | 汽车稳定性控制系统的车速估计方法及系统 | |
CN110979026B (zh) | 一种基于实时路况的分布式驱动公交车转矩分配方法 | |
CN111002976B (zh) | 一种基于模糊自适应pid控制的智能车辆抗侧风控制方法 | |
CN111796522B (zh) | 一种车辆状态估计方法 | |
CN109094644A (zh) | 极限工况下的主动后轮转向与直接横摆力矩控制方法 | |
CN113002324A (zh) | 一种四轮独立驱动和独立转向电动汽车电子差速系统 | |
CN111731267B (zh) | 一种装备非充气弹性车轮的分布式电动汽车稳定性控制系统及方法 | |
CN113247004A (zh) | 一种车辆质量与道路横向坡度的联合估计方法 | |
CN116552550A (zh) | 基于参数不确定性和横摆稳定性的车辆轨迹跟踪控制系统 | |
CN109292018B (zh) | 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法 | |
CN108394413B (zh) | 一种四轮独立驱动与转向的电动汽车状态与参数校正方法 | |
US6853886B2 (en) | Method of estimating quantities that represent state of vehicle | |
CN111497866A (zh) | 一种基于改进马氏距离的转向盘转角传感器故障诊断方法 | |
CN114851857A (zh) | 一种分布式驱动电动客车转矩控制方法 | |
CN109204599B (zh) | 基于同轴式轮腿结构的主动姿态与全轮转向协同控制方法 | |
CN111645696B (zh) | 一种分布式驱动越野车复杂越野工况辨识方法 | |
CN114179818A (zh) | 基于自适应预瞄时间和滑模控制的智能汽车横向控制方法 | |
CN111231976B (zh) | 一种基于变步长的车辆状态估计方法 | |
CN112278072A (zh) | 一种智能车转向安全控制系统及控制方法 | |
CN114148411B (zh) | 一种轮式无人平台的漂移控制方法 | |
CN114896694B (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 |