CN106394561A - 一种车辆的纵向车速的估计方法和装置 - Google Patents
一种车辆的纵向车速的估计方法和装置 Download PDFInfo
- Publication number
- CN106394561A CN106394561A CN201510761540.6A CN201510761540A CN106394561A CN 106394561 A CN106394561 A CN 106394561A CN 201510761540 A CN201510761540 A CN 201510761540A CN 106394561 A CN106394561 A CN 106394561A
- Authority
- CN
- China
- Prior art keywords
- value
- denoising
- vehicle
- vehicle body
- minimum
- 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
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/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
- 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
- B60W2050/0052—Filtering, filters
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Regulating Braking Force (AREA)
Abstract
本发明提供一种车辆的纵向车速的估计方法和装置。所述车辆的纵向车速的估计方法,包括:获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据去噪后的最小或最大轮速值vwe和去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。本发明能够基于车辆轮速信号和车身加速度信号的扩展卡尔曼滤波算法进行车辆纵向速度的估计。
Description
技术领域
本发明涉及一种车轮纵向车速估计技术,尤其是车辆的纵向车速的估计方法和装置。
背景技术
电动汽车具有很好的排放性能,已经得到了广泛应用,电动轮独立驱动的电动车辆具有更高的行驶性能和总体布局优势,电动轮驱动车辆具有轮式车辆的快速行进优势,具备较强的越野能力,是目前各国努力发展的车型之一。通过对各个电动轮的动力输出特性的优化控制,能够实现包括车辆驱动防滑(TSR)、制动防抱死(ABS)和电子稳定控制系统(ESP)等性能。
为了能够实现对多电动轮的优化控制,必须对纵向车速信号进行获取。目前车速的获取主要有直接法和间接法。直接法利用传感器技术,直接测量车辆的行驶速度,如光学传感器、GPS技术等,方法直接、简单,但是成本较高,且受环境条件的影响大。
间接法利用车辆其他传感器获得的信息,建立它们与车速之间的动力学关系,从而估算得到车速。由于间接法成本低、实现方法多样,因此应用广泛。由于轮毂电机的转速可以快速精确地获得,因此间接法尤其适用于电动轮驱动车辆。
一些研究利用非驱动轮的轮速信号来近似估算车速信号,效果较好,但该方法不适用于全轮驱动的车辆;有的研究提出利用轮速信息或车身加速度信息或同时基于这两个信息,通过智能控制算法,来进行车速的估计,如卡尔曼滤波算法、滑模变结构算法、模糊规则算法、递推最小二乘算法等。这些方法从不同的角度采用不同的方法对车速进行估计,更多的在车速估计过程中考虑了非线性特性对车速估计精度的影响,能够得到较高的车速估计数值,但是由于牵涉到较多的非线性运算,实车应用的性能不是很好。
发明内容
本发明要解决的技术问题是,提供一种车辆的纵向车速的估计方法和装置,能够提高车速的估算精度。
为解决上述技术问题,本发明的实施例提供一种车辆的纵向车速的估计方法,包括:
步骤一,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;
步骤二,利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;
步骤三,通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。
所述步骤二根据以下公式实现:
其中,ts是采样时间,ξvw、ξaw和ξax分别是轮胎线速度的系统噪声、轮胎线加速度的系统噪声和车身加速度的系统噪声,λvw和λax分别是轮胎线速度的测量噪声和车身加速度的测量噪声。
所述步骤三根据以下公式实现:
ve,n+1=ve,n+Ts(axe,n+ξvx,n)
vwe,n=ve,n+λvx,n
其中,ξvx是车辆纵向速度的系统噪声,λvx是车辆纵向速度的测量噪声。
所述通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节的步骤包括:
通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值。
所述通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值的步骤包括:
获取上一时刻的车辆纵向速度值ve与去噪后的最小或最大轮速值vwe;
根据公式se=|(vwe-ve)/max(vwe,ve)|,计算车轮滑移率se:
根据所述车轮滑移率,按照模糊规则策略,调整所述去噪后的最小或最大 轮速值vwe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值。
所述模糊规则策略为:
当所述车轮滑移率小于阈值时,增大所述去噪后的最小或最大轮速值vwe的权值,减小所述去噪后的车身加速度值axe的权值;
当所述车轮滑移率大于或者等于阈值时,增大所述去噪后的车身加速度值axe的权值,减小所述去噪后的最小或最大轮速值vwe的权值。
一种车辆的纵向车速的估计装置,包括:
获取单元,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;
第一生成单元,利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;
第二生成单元,通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。
所述第二生成单元包括:
调整子单元,通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和去噪后的车身加速度值axe在第二扩展卡尔曼滤波器算法中的权重值。
所述调整子单元包括:
获取模块,获取上一时刻的车辆纵向速度值ve与去噪后的最小或最大轮速值vwe;
计算模块,根据所述公式se=|(vwe-ve)/max(vwe,ve)|,计算车轮滑移率se:
调整模块,根据所述车轮滑移率,按照模糊规则策略,调整所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器算法中的权重值。
所述模糊规则策略为:
当所述车轮滑移率小于阈值时,增大所述去噪后的最小或最大轮速值vwe的权值,减小所述去噪后的车身加速度值axe的权值;
当所述车轮滑移率大于或者等于阈值时,增大所述去噪后的车身加速度值axe的权值,减小所述去噪后的最小或最大轮速值vwe的权值。
本发明的上述技术方案的有益效果如下:本发明中,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve,能够提高车速的估算精度。
附图说明
图1是本发明所述的一种车辆的纵向车速的估计方法的流程示意图;
图2是本发明所述的一种车辆的纵向车速的估计装置的连接示意图;
图3是本发明的应用场景中全电动轮驱动车辆整车纵向速度的估算方法的示意图。
图4A和图4B是本发明的应用场景中车辆纵向动力学模型;
图5A和图5B是本发明的应用场景中输入变量的隶属度函数图;
图6A和图6B是本发明的应用场景中输出变量的隶属函数图
图7是本发明的应用场景中系统噪声Q2的曲面观测图;
图8是本发明的应用场景中测量噪声R2的曲面观测图。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述。
如图1所示,为本发明所述的一种车辆的纵向车速的估计方法,包括:
步骤11,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;
步骤12,利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;
步骤13,通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。
所述步骤12根据以下公式实现:
其中,ts是采样时间,ξvw、ξaw和ξax分别是轮胎线速度的系统噪声、轮胎线加速度的系统噪声和车身加速度的系统噪声,λvw和λax分别是轮胎线速度的测量噪声和车身加速度的测量噪声。
所述步骤13根据以下公式实现:
ve,n+1=ve,n+Ts(axe,n+ξvx,n)
vwe,n=ve,n+λvx,n
其中,ξvx是车辆纵向速度的系统噪声,λvx是车辆纵向速度的测量噪声。
所述通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节的步骤包括:
通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值。
所述通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值的步骤包括:
获取上一时刻的车辆纵向速度值ve与去噪后的最小或最大轮速值vwe;
根据公式se=|(vwe-ve)/max(vwe,ve)|,计算车轮滑移率se:
根据所述车轮滑移率,按照模糊规则策略,调整所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值。
所述模糊规则策略为:
当所述车轮滑移率小于阈值时,增大所述去噪后的最小或最大轮速值vwe的权值,减小所述去噪后的车身加速度值axe的权值;
当所述车轮滑移率大于或者等于阈值时,增大所述去噪后的车身加速度值axe的权值,减小所述去噪后的最小或最大轮速值vwe的权值。
如图2所示,为本发明所述的一种车辆的纵向车速的估计装置,包括:
获取单元21,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;
第一生成单元22,利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;
第二生成单元23,通过模糊控制器,对第二扩展卡尔曼滤波器的估算参 数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。
所述第二生成单元23包括:
调整子单元231,通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和去噪后的车身加速度值axe在第二扩展卡尔曼滤波器算法中的权重值。
所述调整子单元231包括:
获取模块2311,获取上一时刻的车辆纵向速度值ve与去噪后的最小或最大轮速值vwe;
计算模块2312,根据所述公式se=|(vwe-ve)/max(vwe,ve)|,se计算车轮滑移率:
调整模块2313,根据所述车轮滑移率,按照模糊规则策略,调整所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器算法中的权重值。
所述模糊规则策略为:
当所述车轮滑移率小于阈值时,增大所述去噪后的最小或最大轮速值vwe的权值,减小所述去噪后的车身加速度值axe的权值;
当所述车轮滑移率大于或者等于阈值时,增大所述去噪后的车身加速度值axe的权值,减小所述去噪后的最小或最大轮速值vwe的权值。
以下描述本发明的应用场景。
本发明提供一种采用电动轮独立驱动电动汽车的纵向车速估算方法,包括了车轮轮速采集装置、车身加速度采集装置,基于车辆轮速信号和车身加速度信号的卡尔曼滤波算法进行电动轮独立驱动电动车辆的纵向速度估计。包括两个扩展卡尔曼滤波器,扩展卡尔曼滤波器1主要负责对车轮轮速采集装置和车身加速度采集装置测量信号进行滤波去噪处理,扩展卡尔曼滤波器2主要负责车辆纵向速度的估算,并通过模糊控制器,对扩展卡尔曼滤波器2的估算参数进行实时动态地调节,调整轮速信号和车身加速度信号在算法中的权重值,实现了估计算法的自适应性。该发明采用成熟传感器技术,实现了独立驱动车辆纵向车速的准确估计方法。
本应用场景为一种全电动轮驱动的车辆整车纵向速度的估算方法,即一种独立电动轮驱动的电动汽车的纵向速度的估计方法,以全电动轮驱动车辆为研究对象,利用车辆可采集的轮速信号和车身加速度信号,设计了基于模糊规则的扩展卡尔曼滤波器,实现对测量信号的滤波去噪处理和纵向车速的估算,通过模糊控制器动态调节滤波器的参数,实现了估计算法的自适应性。
本发明采用的车辆纵向速度的估计算法原理图如图3所示,vwi、ax分别是动力学模型输出的各车轮的旋转线速度和车身纵向加速度,分别叠加随机噪声noiseu和noisea后得到vwmi和axm,以模拟实车上轮速传感器和车辆加速度传感器得到的带有测量噪声的测量值。
基于模糊卡尔曼滤波的车速估计算法包含两个扩展卡尔曼滤波器和一个模糊控制器。
扩展卡尔曼滤波器1(第一扩展卡尔曼滤波器):主要作用是对带有噪声干扰的测量信号vwmi和axm(旋转线速度和车身纵向加速度)进行滤波处理,得到去噪后的最小或最大轮速值vwe及对应的线加速度值awe、车身加速度值axe:若 axe≥0,即车辆在加速状态,则vwe取最小轮速值;反之取最大轮速值。
扩展卡尔曼滤波器2(第二扩展卡尔曼滤波器):主要作用是根据去噪后的轮速值和车身加速度值,估计当前时刻的车辆纵向速度值vxe。
在车身估计过程中,根据工况的变化,通过模糊控制器实时调整滤波器2的参数Q2和R2,使估算结果更加准确,实现算法的自适应性。
以下具体说明。本发明研究车辆的纵向车速的估计。假设车辆在平直的道路上直线行驶,车辆沿纵向轴线对称,仅考虑车辆的纵向运动,考虑车身俯仰运动,而不考虑车身和车轮的垂向直线运动,忽略空气助力和滚动助力。所建立的模型包含6个自由度:整车纵向速度v,车身俯仰角速度q,四个车轮绕其轮轴的旋转角速度ωi(i=1,2,3,4)。
图4A和图4B为车辆的纵向动力学模型,取车辆前进方向为x,车辆左侧为y,垂直xy平面向上为z,俯仰角速度q如图4B所示为正。动力学方程如下:
式中,i=1,2,3,4,为车轮序号;m是整车质量;ms是车身质量;Iys是车身绕y轴的俯仰惯量;Iw是车轮转动惯量;v是车辆纵向速度;q是车身俯仰角 速度;θ是车身俯仰角;ω是车轮旋转角速度;Fx是地面对车轮的切向力;a、b分别是前后轴至质心的距离;hs是车身质心高度;Td、Tb分别是驱动力矩和制动力矩;R是车轮半径;Fsf是前轴对车身的作用力;Fsr是后轴对车身的作用力,都可以通过车辆受力情况分析得到。
以车辆静平衡为参考状态,该状态下,前后轴对车身的作用力分别为
车辆俯仰运动时,悬架在垂向有变形,产生附加动态的悬架力,如图4B,Ks和Cs是悬架的刚度和阻尼。前后轴悬架相对于静平衡位置的变形量分别为
Zf=a·sinθ;Zr=b·sinθ (5)
前后轴悬架附加的变形力分别为
因此,车辆在俯仰运动时,前后轴对车身的作用力分别为
Fsf=ΔFsf+Fsf0;Fsr=ΔFsr+Fsr0. (7)
各车轮的垂向力分别为
Fzw1=Fzw2=0.5·Fzsf+mwg;Fzw3=Fzw4=0.5·Fzsr+mwg (8)
mw是轮胎质量。
以下描述扩展卡尔曼滤波器的设计。
假设离散对象的系统状态方程和测量方程分别为:
Xn+1=A·Xn+B·(Un+ξn) (9)
Yn=C·Xn+λn (10)
式中,A、B、C分别为系统矩阵、输入矩阵和测量矩阵;Xn、Un、Yn分别为n时刻的状态变量列矩阵、输入变量(或控制变量)列矩阵和输出变量(或测量变量)列矩阵;ξn和λn分别为系统噪声列矩阵和测量噪声列矩阵,假设它们为零均值、独立的高斯分布噪声,其协方差矩阵分别为Q和R。
n为当前采样时刻;n+1为当前采样时刻的下一时刻。
卡尔曼滤波算法基于系统的状态空间表达式(9)、(10),进行如下时间更新和测量校正运算。时间更新是根据当前采样时刻的估计值Xn预测下一时刻的动态值Xn+1,n:
Xn+1,n=A·Xn+B·Un (11)
由于系统噪声ξn的存在,上式的结果与真实值存在误差,误差的协方差为:
Pn+1,n=Xn+1-Xn+1,n=A·Pn·AT+Qn (12)
因此,需要定义增益矩阵K,以校正时间更新中产生的误差:
Kn+1,n=Pn+1,n·CT·(C·Pn+1,n·CT+Rn)-1 (13)
测量校正是利用增益矩阵和测量变量对初步预测的动态值Xn+1,n进行修正,得到下一时刻估计值Xn+1:
Xn+1=Xn+1,n+Pn+1,n
=Xn+1,n+Kn+1(Yn-C·Xn+1,n) (14)
最后,更新估计误差的协方差,用于下一采样时刻的迭代估算:
Pn+1=(I-Kn+1·C)·Pn+1,n (15)
I是单位矩阵。
以下描述扩展卡尔曼滤波器的设计。
扩展卡尔曼滤波器1的主要作用是对带有噪声的测量信号uwmi和axm进行滤波去噪处理,并根据车辆的加减速情况输出最小或最大轮速滤波值uωe、车轮线加速度值awe和车身加速度滤波值axe。
为了取得稳定的滤波效果,系统噪声和测量噪声的协方差矩阵Q1和R1取为定值。对象的离散的状态方程和测量方程为:
扩展扩展卡尔曼滤波器2根据去噪后的最小或最大轮速值vωe和车身加速度值axe,估算出车辆的前进速度ve,对应的离散状态方程和测量方程为:
ve,n+1=ve,n+Ts·(axe,n+sux,n) (18)
vwe,n=ve,n+λux,n (19)
其中,λux是车辆纵向速度的测量噪声;sux是车辆纵向速度的系统噪声。
加速度axe可以认为是滤波器的输入(或控制)变量,轮速Vωe是滤波器的测量变量。由式(9)~(19)便可以构建扩展扩展卡尔曼滤波器1和2,利用Matlab软件的函数编辑功能,可以方便地编写扩展卡尔曼滤波器的M文件。
以下描述模糊控制器的设计。
为了使算法在不同行驶工况下都具有良好的适应性和估算精度,本发明通过模糊控制器实时调整滤波器的参数Q2和R2,一方面进一步补偿滤波器1中的误差,另一方面实时改变轮速信号和加速度信号在估计算法中的权重程度。
如图3所示,模糊控制器的输入为上一时刻的轮速vωe、轮线加速度awe、车身加速度axe和反馈的估计车速ve。
令Ea=|awe-axe|,表示车身加速度与车轮线加速度之差的绝对值;Se=|(vwe-ve)/max(vwe,ve)|,表示根据测量的轮速与估算的车速得到的滑转率或滑移率,以它们作为车轮打滑或抱死程度的判定依据。
当车辆在附着系数良好的路面行驶时,车轮不发生打滑或抱死,这种情况下,应增大轮速vωe在估计算法中的权值,减小车身加速度axe的权值,以避免累积加速度的静态偏差;
当车辆在附着系数低的路面行驶时,车轮容易打滑或抱死,因此应增大车身加速度axe的权值,减小轮速vωe的权值,实现算法的适应性。
通过模糊控制器实时调整滤波器参数Q2和R2,需要进行理论分析和大量仿真试验,以积累足够的专家经验,从而制定模糊规则。模糊规则的输入为Ea和Se,表1为控制Q2和R2的模糊规则表,其中VS、S、M、L分别表示很小、 小、中、大。
表1为模糊规则表。
利用Matlab/Simulink的模糊控制工具箱,可以方便地生成所需的模糊控制器。各输入输出的隶属度函数图如图3所示,图5A和图5B是本发明的应用场景中输入变量的隶属度函数图;图6A和图6B是本发明的应用场景中输出变量的隶属函数图;基于规则表1的输出量Q2和R2的曲面观测图如图7和图8所示,模糊控制器的解模糊化方法采用重心法。
本发明中,所建立的系统离散状态方程和测量方程能正确地描述输入输出关系;扩展卡尔曼滤波器1能较好地对带噪的测量信号进行滤波去噪处理,得到的信号平滑且不失真;扩展卡尔曼滤波器2能在模糊控制器的调节作用下,实时准确地估算不同路面条件和行驶工况下的车速。
另外,本发明中,以车身加速度和车轮线加速度的差值、和上一时刻所估算的车速与轮速的差值作为判断车轮滑移状态的依据,并以此作为模糊控制器的输入,所设计的模糊规则能根据车辆的滑移率改变轮速信号和车身加速度信 号在估计算法中的权重值,以实时调整滤波器的参数,使得估计算法具有较强的自适应性。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明所述原理的前提下,还可以作出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种车辆的纵向车速的估计方法,其特征在于,包括:
步骤一,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;
步骤二,利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;
步骤三,通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。
2.根据权利要求1所述的方法,其特征在于,所述步骤二根据以下公式实现:
其中,ts是采样时间,ξvw、ξaw和ξax分别是轮胎线速度的系统噪声、轮胎线加速度的系统噪声和车身加速度的系统噪声,λvw和λax分别是轮胎线速度的测量噪声和车身加速度的测量噪声。
3.根据权利要求1所述的方法,其特征在于,所述步骤三根据以下公式实现:
ve,n+1=ve,n+Ts(axe,n+ξvx,n)
vwe,n=ve,n+λvx,n
其中,ξvx是车辆纵向速度的系统噪声,λvx是车辆纵向速度的测量噪声。
4.根据权利要求1所述的方法,其特征在于,所述通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节的步骤包括:
通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值。
5.根据权利要求4所述的方法,其特征在于,所述通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值的步骤包括:
获取上一时刻的车辆纵向速度值ve与去噪后的最小或最大轮速值vwe;
根据公式se=|(vwe-ve)/max(vwe,ve)|,计算车轮滑移率se:
根据所述车轮滑移率,按照模糊规则策略,调整所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器的算法中的权重值。
6.根据权利要求5所述的方法,其特征在于,所述模糊规则策略为:
当所述车轮滑移率小于阈值时,增大所述去噪后的最小或最大轮速值vwe的权值,减小所述去噪后的车身加速度值axe的权值;
当所述车轮滑移率大于或者等于阈值时,增大所述去噪后的车身加速度值axe的权值,减小所述去噪后的最小或最大轮速值vwe的权值。
7.一种车辆的纵向车速的估计装置,其特征在于,包括:
获取单元,获取车辆的带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm;
第一生成单元,利用第一扩展卡尔曼滤波器,对所述带测量噪声的车轮线速度vwmi和带测量噪声的车速纵向加速度axm进行滤波去噪处理,生成去噪后的最小或最大轮速值vwe及去噪后的轮胎线加速度值awe、去噪后的车身加速度值axe;
第二生成单元,通过模糊控制器,对第二扩展卡尔曼滤波器的估算参数进行实时动态地调节,并利用所述第二扩展卡尔曼滤波器,根据所述去噪后的最小或最大轮速值vwe和所述去噪后的车身加速度值axe,输出当前时刻的车辆纵向速度值ve。
8.根据权利要求7所述的装置,其特征在于,所述第二生成单元包括:
调整子单元,通过模糊控制器,调整所述去噪后的最小或最大轮速值vωe和去噪后的车身加速度值axe在第二扩展卡尔曼滤波器算法中的权重值。
9.根据权利要求7所述的装置,其特征在于,所述调整子单元包括:
获取模块,获取上一时刻的车辆纵向速度值ve与去噪后的最小或最大轮速值vwe;
计算模块,根据所述公式se=|(vwe-ve)/max(vwe,ve)|,计算车轮滑移率se:
调整模块,根据所述车轮滑移率,按照模糊规则策略,调整所述去噪后的 最小或最大轮速值vwe和所述去噪后的车身加速度值axe在第二扩展卡尔曼滤波器算法中的权重值。
10.根据权利要求9所述的装置,其特征在于,所述模糊规则策略为:
当所述车轮滑移率小于阈值时,增大所述去噪后的最小或最大轮速值vwe的权值,减小所述去噪后的车身加速度值axe的权值;
当所述车轮滑移率大于或者等于阈值时,增大所述去噪后的车身加速度值axe的权值,减小所述去噪后的最小或最大轮速值vwe的权值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510761540.6A CN106394561B (zh) | 2015-11-10 | 2015-11-10 | 一种车辆的纵向车速的估计方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510761540.6A CN106394561B (zh) | 2015-11-10 | 2015-11-10 | 一种车辆的纵向车速的估计方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106394561A true CN106394561A (zh) | 2017-02-15 |
CN106394561B CN106394561B (zh) | 2018-07-27 |
Family
ID=58007788
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510761540.6A Active CN106394561B (zh) | 2015-11-10 | 2015-11-10 | 一种车辆的纵向车速的估计方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106394561B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107891865A (zh) * | 2017-10-26 | 2018-04-10 | 北京新能源汽车股份有限公司 | 一种车轮滑转率的获取方法、装置、控制器及电动汽车 |
CN107985318A (zh) * | 2017-11-29 | 2018-05-04 | 吉林大学 | 轮式装载机重心纵向位置和重心高度动态估计方法 |
CN109307782A (zh) * | 2017-07-28 | 2019-02-05 | 华创车电技术中心股份有限公司 | 车速估算装置、车速估算方法、及计算器可读介质 |
CN109466558A (zh) * | 2018-10-26 | 2019-03-15 | 重庆邮电大学 | 一种基于ekf和bp神经网络的路面附着系数估计方法 |
CN109515445A (zh) * | 2018-11-23 | 2019-03-26 | 安徽猎豹汽车有限公司 | 一种用于全轮独立驱动车辆的纵向车速估计方法及其装置 |
CN110304070A (zh) * | 2019-05-30 | 2019-10-08 | 成都九鼎科技(集团)有限公司 | 一种分布式独立驱动汽车纵向车速估计方法 |
CN110395201A (zh) * | 2019-08-07 | 2019-11-01 | 大连华锐重工焦炉车辆设备有限公司 | 一种分布式混合驱动无人框架车的整车控制器软件开发方法 |
CN110920629A (zh) * | 2019-12-13 | 2020-03-27 | 华人运通(江苏)技术有限公司 | 车辆车速计算方法、装置及计算机可读存储介质 |
CN111086520A (zh) * | 2020-01-17 | 2020-05-01 | 北京理工大学 | 一种适用于四轮驱动车辆多轮高滑移率时的速度估计算法 |
CN111137075A (zh) * | 2018-11-06 | 2020-05-12 | 现代自动车株式会社 | 用于估计轮胎共振频率的装置和方法 |
CN111806430A (zh) * | 2020-06-03 | 2020-10-23 | 惠州市德赛西威汽车电子股份有限公司 | 一种用于自动泊车的车速计算方法 |
CN111845755A (zh) * | 2020-06-10 | 2020-10-30 | 武汉理工大学 | 一种车辆纵向车速估计方法 |
CN112550300A (zh) * | 2019-09-25 | 2021-03-26 | 比亚迪股份有限公司 | 车速检测方法、装置、存储介质、电子设备及车辆 |
CN113353066A (zh) * | 2021-06-30 | 2021-09-07 | 中汽创智科技有限公司 | 一种障碍物触碰识别方法、装置、设备及存储介质 |
CN114026435A (zh) * | 2019-04-23 | 2022-02-08 | 雷诺股份公司 | 用于估计和调整车辆的速度和加速度的方法 |
CN115416654A (zh) * | 2022-11-03 | 2022-12-02 | 北京清研宏达信息科技有限公司 | 一种基于自抗扰的人机共驾车速控制方法及系统 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110562263B (zh) * | 2019-09-19 | 2020-11-10 | 中国人民解放军陆军装甲兵学院 | 一种基于多模型融合的轮毂电机驱动车辆车速估计方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102007015066A1 (de) * | 2007-03-29 | 2008-10-02 | Continental Teves Ag & Co. Ohg | Verfahren und Vorrichtung zur Regelung des Antriebsschlupfes |
CN101801755A (zh) * | 2007-09-14 | 2010-08-11 | 丰田自动车株式会社 | 车体速度推定设备 |
CN102009654A (zh) * | 2010-11-12 | 2011-04-13 | 清华大学 | 一种全轮电驱动车辆的纵向车速估计方法 |
CN102556075A (zh) * | 2011-12-15 | 2012-07-11 | 东南大学 | 一种基于改进扩展卡尔曼滤波的车辆运行状态估计方法 |
CN102700551A (zh) * | 2012-05-31 | 2012-10-03 | 清华大学 | 一种车辆行驶过程中路面坡度的实时估计方法 |
EP2187223B1 (en) * | 2008-11-14 | 2014-01-08 | Robert Bosch GmbH | System and method for compensating vehicle sensor signals |
-
2015
- 2015-11-10 CN CN201510761540.6A patent/CN106394561B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102007015066A1 (de) * | 2007-03-29 | 2008-10-02 | Continental Teves Ag & Co. Ohg | Verfahren und Vorrichtung zur Regelung des Antriebsschlupfes |
CN101801755A (zh) * | 2007-09-14 | 2010-08-11 | 丰田自动车株式会社 | 车体速度推定设备 |
EP2187223B1 (en) * | 2008-11-14 | 2014-01-08 | Robert Bosch GmbH | System and method for compensating vehicle sensor signals |
CN102009654A (zh) * | 2010-11-12 | 2011-04-13 | 清华大学 | 一种全轮电驱动车辆的纵向车速估计方法 |
CN102556075A (zh) * | 2011-12-15 | 2012-07-11 | 东南大学 | 一种基于改进扩展卡尔曼滤波的车辆运行状态估计方法 |
CN102700551A (zh) * | 2012-05-31 | 2012-10-03 | 清华大学 | 一种车辆行驶过程中路面坡度的实时估计方法 |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109307782A (zh) * | 2017-07-28 | 2019-02-05 | 华创车电技术中心股份有限公司 | 车速估算装置、车速估算方法、及计算器可读介质 |
CN109307782B (zh) * | 2017-07-28 | 2020-10-27 | 华创车电技术中心股份有限公司 | 车速估算装置、车速估算方法、及计算器可读介质 |
CN107891865A (zh) * | 2017-10-26 | 2018-04-10 | 北京新能源汽车股份有限公司 | 一种车轮滑转率的获取方法、装置、控制器及电动汽车 |
CN107985318A (zh) * | 2017-11-29 | 2018-05-04 | 吉林大学 | 轮式装载机重心纵向位置和重心高度动态估计方法 |
CN107985318B (zh) * | 2017-11-29 | 2019-10-25 | 吉林大学 | 轮式装载机重心纵向位置和重心高度动态估计方法 |
CN109466558A (zh) * | 2018-10-26 | 2019-03-15 | 重庆邮电大学 | 一种基于ekf和bp神经网络的路面附着系数估计方法 |
CN111137075A (zh) * | 2018-11-06 | 2020-05-12 | 现代自动车株式会社 | 用于估计轮胎共振频率的装置和方法 |
CN109515445A (zh) * | 2018-11-23 | 2019-03-26 | 安徽猎豹汽车有限公司 | 一种用于全轮独立驱动车辆的纵向车速估计方法及其装置 |
CN114026435A (zh) * | 2019-04-23 | 2022-02-08 | 雷诺股份公司 | 用于估计和调整车辆的速度和加速度的方法 |
CN110304070A (zh) * | 2019-05-30 | 2019-10-08 | 成都九鼎科技(集团)有限公司 | 一种分布式独立驱动汽车纵向车速估计方法 |
CN110395201A (zh) * | 2019-08-07 | 2019-11-01 | 大连华锐重工焦炉车辆设备有限公司 | 一种分布式混合驱动无人框架车的整车控制器软件开发方法 |
CN112550300A (zh) * | 2019-09-25 | 2021-03-26 | 比亚迪股份有限公司 | 车速检测方法、装置、存储介质、电子设备及车辆 |
CN112550300B (zh) * | 2019-09-25 | 2022-05-13 | 比亚迪股份有限公司 | 车速检测方法、装置、存储介质、电子设备及车辆 |
CN110920629A (zh) * | 2019-12-13 | 2020-03-27 | 华人运通(江苏)技术有限公司 | 车辆车速计算方法、装置及计算机可读存储介质 |
CN110920629B (zh) * | 2019-12-13 | 2021-08-27 | 华人运通(江苏)技术有限公司 | 车辆车速计算方法、装置及计算机可读存储介质 |
CN111086520A (zh) * | 2020-01-17 | 2020-05-01 | 北京理工大学 | 一种适用于四轮驱动车辆多轮高滑移率时的速度估计算法 |
CN111806430A (zh) * | 2020-06-03 | 2020-10-23 | 惠州市德赛西威汽车电子股份有限公司 | 一种用于自动泊车的车速计算方法 |
CN111806430B (zh) * | 2020-06-03 | 2021-12-31 | 惠州市德赛西威汽车电子股份有限公司 | 一种用于自动泊车的车速计算方法 |
CN111845755A (zh) * | 2020-06-10 | 2020-10-30 | 武汉理工大学 | 一种车辆纵向车速估计方法 |
CN113353066A (zh) * | 2021-06-30 | 2021-09-07 | 中汽创智科技有限公司 | 一种障碍物触碰识别方法、装置、设备及存储介质 |
CN115416654A (zh) * | 2022-11-03 | 2022-12-02 | 北京清研宏达信息科技有限公司 | 一种基于自抗扰的人机共驾车速控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN106394561B (zh) | 2018-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106394561B (zh) | 一种车辆的纵向车速的估计方法和装置 | |
CN103407451B (zh) | 一种道路纵向附着系数估计方法 | |
Osinenko et al. | A method of optimal traction control for farm tractors with feedback of drive torque | |
CN103434511B (zh) | 一种车速与道路附着系数的联合估计方法 | |
US6508102B1 (en) | Near real-time friction estimation for pre-emptive vehicle control | |
CN102673569B (zh) | 车辆状态测算装置、方法及使用该装置的车辆 | |
CN108819950B (zh) | 汽车稳定性控制系统的车速估计方法及系统 | |
KR101470221B1 (ko) | 현가 제어 장치 및 그 방법 | |
CN102165300B (zh) | 用于求出汽车重心的方法和设备 | |
CN105151047A (zh) | 一种汽车质心侧偏角测量方法 | |
CN101474953A (zh) | 悬架控制装置 | |
CN104354700A (zh) | 一种基于无迹卡尔曼滤波的车辆参数在线估计方法 | |
CN106515716A (zh) | 轮式驱动电动汽车底盘集成控制系统协调控制装置及方法 | |
CN105270397B (zh) | 车辆电子稳定性控制系统稳定性控制判据的制定方法 | |
CN107000755A (zh) | 用于估计影响车辆动力学的变量的方法和对应的虚拟传感器 | |
CN111547059A (zh) | 一种分布式驱动电动汽车惯性参数估计方法 | |
Tanelli et al. | Combined vehicle velocity and tire-road friction estimation via sliding mode observers | |
CN103279675B (zh) | 轮胎-路面附着系数与轮胎侧偏角的估计方法 | |
Li et al. | A variable structure adaptive extended Kalman filter for vehicle slip angle estimation | |
CN110497915B (zh) | 一种基于加权融合算法的汽车行驶状态估计方法 | |
CN113460056B (zh) | 一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 | |
CN109591821A (zh) | 轮胎受力计算方法、装置和车载计算机设备 | |
CN111006884B (zh) | 基于傅立叶变换的车轮车轴侧偏角与侧偏刚度的测量方法 | |
Jang et al. | Lateral handling improvement with dynamic curvature control for an independent rear wheel drive EV | |
Xu et al. | Direct tire slip ratio estimation using intelligent tire system and machine learning algorithms |
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 | ||
CB03 | Change of inventor or designer information | ||
CB03 | Change of inventor or designer information |
Inventor after: Wang Zhifu Inventor after: Xu Yang Inventor before: Wang Zhifu Inventor before: Xu Yang |