CN106515740B - 基于icdkf的分布式电驱动汽车行驶状态参数估计算法 - Google Patents
基于icdkf的分布式电驱动汽车行驶状态参数估计算法 Download PDFInfo
- Publication number
- CN106515740B CN106515740B CN201610998379.9A CN201610998379A CN106515740B CN 106515740 B CN106515740 B CN 106515740B CN 201610998379 A CN201610998379 A CN 201610998379A CN 106515740 B CN106515740 B CN 106515740B
- Authority
- CN
- China
- Prior art keywords
- icdkf
- state
- freedom
- degree
- dynamic model
- 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
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
-
- 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
-
- 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/14—Yaw
-
- 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/20—Sideslip angle
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)
- Navigation (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,属于分布式电驱动汽车技术领域。本发明涉及的方法包括:1)建立三自由度非线性车辆动力学模型;2)将三自由度非线性车辆动力学模型离散化;3)基于2)中离散化的三自由度非线性车辆动力学模型,用迭代中心差分卡尔曼滤波对分布式驱动电动汽车行驶状态参数(包括横摆角速度、质心侧偏角和纵向车速)进行估计。本发明充分利用最新量测信息,可有效提高状态估计精度和估计收敛速度,具有受环境因素影响小、成本低和可靠性高等优点,适用于分布式电驱动汽车的行驶状态参数估计。
Description
技术领域
本发明属于分布式电驱动汽车技术领域,具体涉及基于ICDKF的分布式电驱动汽车行驶状态参数估计算法。
背景技术
分布式电驱动汽车采用把电机直接安装在四个车轮内作为驱动执行器的动力布置形式,与传统内燃机汽车相比,具有传动链短、传动高效和结构紧凑等突出优点,给汽车动力学控制引入了一种全新的实现形式,同时也对车辆行驶状态参数的估计精度和实时性提出了更高的要求。对分布式电驱动汽车进行动力学控制,必须知道车辆行驶状态参数,以资动力学控制参考。因此,研究分布式电驱动汽车的动力学控制必须考虑对其行驶状态参数估计。
中国专利CN102343912A公开了一种汽车行驶过程中的状态估计方法,该发明引入非完整性约束,进而建立速度误差估计方程,通过车速以及车辆的三个姿态角来估计车辆行驶中侧向以及垂直方向的误差,建立质心侧偏角估计方程,但该方法需要使用GPS等传感器,受环境因素影响较大,成本较高,可靠性不高;中国专利CN105151047A公开了一种汽车质心侧偏角测量方法,该发明分别用线性二、三自由度车辆动力学模型分别估计得到一个质心侧偏角,然后根据量测横向加速度信息分配两个质心侧偏角的权重,最后得到质心侧偏角估计值,但是该方法直接把量测纵向加速度积分作为纵向车速,误差较大;中国专利CN102556075A提出了一种基于改进扩展卡尔曼滤波的车辆运行状态估计方法,来实现质心侧偏角、横摆角速度和纵向车速进行估计,可改善汽车在较高机动运行状态下状态的估计精度,但是引入了轮胎纵向力建模这一非线性较强的因素,而且在极限工况等非线性极强的工况下,该估计算法仍极有可能发散,因此可靠性不高。
发明内容
本发明提供了基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,受环境因素影响小、成本低、可靠性高,能有效克服上述现有技术的局限性。
本发明采用以下技术方案:
基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,包括以下步骤:
S1,建立三自由度非线性车辆动力学模型,三自由度包括纵向、横向及横摆;
S2,将三自由度非线性车辆动力学模型离散化;
S3,基于S2中离散化的三自由度非线性车辆动力学模型,用ICDKF对分布式电驱动汽车行驶状态参数进行估计,行驶状态参数包括横摆角速度γ、质心侧偏角β和纵向车速vx。
进一步,所述非线性车辆动力学模型的状态方程、观测方程分别为:
其中:a、b分别是前、后轴到车辆质心的距离;k1、k2分别是前、后轮总侧偏刚度;Iz是横摆惯量;δ是前轮转角,δsw是转向盘转角,i是转向系统传动比;m是整车质量,ax、ay分别是车辆传感器测量纵、横向加速度。
进一步,状态方程、观测方程离散化分别为:
其中:k为迭代次数,Δt为采样时间间隔。
进一步,所述用ICDKF对分布式电驱动汽车行驶状态参数进行估计的具体过程为:
S3.1,赋初始值:状态变量x=[γ β vx]T和误差协方差矩阵Px的初值分别为:和
S3.2,确定时间更新Sigma点集其中h为中心差分区间长度;
S3.3,时间更新:将Sigma点通过三自由度非线性车辆动力学模型离散化状态方程F(·)进行变换得到状态量Sigma点集由变换后的状态量Sigma点集计算状态一步预测和方差Pk/k-1;
S3.4,测量更新:由S3.3中得到的状态一步预测进行迭代初始化,然后进行迭代循环,得到估计状态量和误差协方差。
更进一步,所述S3.4中迭代循环的具体过程为:
a)迭代循环开始,构造测量更新Sigma点集:j=0,1,2…n;
b)将每个Sigma点通过三自由度非线性车辆动力学模型离散化观测方程H(·)进行变换得到观测量Sigma点集
c)由变换后的观测量Sigma点集计算得一步预测和自协方差阵和互协方差阵
d)计算滤波增益
e)用标准卡尔曼滤波更新公式对下一时刻的状态量和状态量误差协方差进行更新;
f)得到估计状态量和误差协方差,迭代循环结束。
更进一步,所述标准卡尔曼滤波更新公式为:
本发明的有益效果是:分布式电驱动汽车行驶状态参数估计是一个非线性滤波问题,即从带有噪声的非线性观测量中估计时变的状态量。当汽车在极限工况下工作时,系统的非线性严重、初值估计误差较大,系统观测性弱。本方法结合Gauss-Newton迭代方法,并改进迭代过程产生的新息方差和协方差,通过重复利用观测信息,有效提高估计精度;本方法耗费计算量较少,实时性好。
附图说明
图1为三自由度非线性车辆动力学模型;
图2为基于ICDKF的分布式电驱动汽车行驶状态参数估计流程图;
图3为基于ICDKF的分布式电驱动汽车行驶状态参数估计算法的实施示意图。
具体实施方式
下面将结合附图对本发明作进一步说明,但本发明的保护范围并不限于此。
迭代中心差分卡尔曼滤波(Iterated Central Difference Kalman Filter,ICDKF)是在中心差分卡尔曼滤波的基础上发展起来的一种非线性滤波方法,它结合Gauss-Newton迭代方法并改进迭代过程产生的新息方差和协方差,通过重复利用观测信息,使得状态的观测更新值代替预测值。基于迭代中心差分卡尔曼滤波的分布式电驱动汽车行驶状态参数估计算法,是基于前轮转向的分布式电驱动汽车,为满足汽车动力学控制中对车辆行驶状态参数估计需要,建立三自由度非线性车辆动力学模型并离散化,然后利用ICDKF对离散化的三自由度非线性车辆动力学模型进行滤波估计。本发明只需利用转向盘传感器、纵横向加速度传感器等低成本传感器采集估计算法输入信息,可有效提高估计精度和估计收敛速度。
如图2所示,基于ICDKF的分布式电驱动汽车行驶状态参数估计流程图(图中ICDKF算法估计模块用于估计状态量及其误差协方差),包括步骤:
S1,建立三自由度非线性车辆动力学模型,如图1所示,三自由度包括纵向、横向及横摆;
状态方程:
观测方程:
其中:状态变量γ、β、vx分别是车辆横摆角速度、质心侧偏角、纵向车速;a、b分别是前、后轴到车辆质心的距离;k1、k2分别是前、后轮总侧偏刚度;Iz是横摆惯量;δ是前轮转角,δsw是转向盘转角,i是转向系统传动比;m是整车质量,ax、ay分别是传感器测量纵、横向加速度。
S2,将三自由度非线性车辆动力学模型离散化;
状态方程(1)离散化:
观测方程(2)离散化:
其中:k为迭代次数,Δt为采样时间间隔。
S3,基于S2中离散化的三自由度非线性车辆动力学模型,用ICDKF对分布式电驱动汽车行驶状态参数进行估计,行驶状态参数包括横摆角速度γ、质心侧偏角β和纵向车速vx。
(1)赋初始值:
状态变量x=[γ β vx]T和误差协方差矩阵Px的初值分别为:
(2)确定时间更新Sigma点集:
其中,h为中心差分区间长度,对于高斯分布而言,其最优值为
(3)时间更新:
将Sigma点通过三自由度非线性车辆动力学模型离散化状态方程F(·)进行变换,得到状态量Sigma点集
由变换后的状态量Sigma点集计算得状态一步预测和方差Pk/k-1为:
式中:
(4)测量更新:
迭代初始化:
迭代循环:for j=0:N;
a)构造量测更新Sigma点集:
其中,j=0,1,2…n;
b)将每个Sigma点通过三自由度非线性车辆动力学模型离散化观测方程H(·)进行变换,得到观测量Sigma点集
c)由变换后的观测量Sigma点集计算一步预测和自协方差阵和互协方差阵
d)计算得滤波增益为:
e)使用标准卡尔曼滤波更新公式对下一时刻的状态和协方差更新:
j=j+1 (19)
f)得到估计状态量和误差协方差,迭代循环结束。
其中,迭代次数N取3。
图3所示为基于ICDKF的分布式电驱动汽车行驶状态参数估计算法的实施示意图。
以上说明仅仅为本发明的较佳实施例,本发明并不限于列举上述实施例,应当说明的是,任何熟悉本领域的技术人员在本说明书的教导下,所做出的所有等同替代、明显变形形式,均落在本说明书的实质范围之内,理应受到本发明保护。
Claims (6)
1.基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,其特征在于,包括以下步骤:
S1,建立三自由度非线性车辆动力学模型,三自由度包括纵向、横向及横摆;
S2,将三自由度非线性车辆动力学模型离散化;
S3,基于S2中离散化的三自由度非线性车辆动力学模型,用ICDKF对分布式电驱动汽车行驶状态参数进行估计,行驶状态参数包括横摆角速度γ、质心侧偏角β和纵向车速vx。
2.根据权利要求1所述的基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,其特征在于,所述非线性车辆动力学模型的状态方程、观测方程分别为:
其中:a、b分别是前、后轴到车辆质心的距离;k1、k2分别是前、后轮总侧偏刚度;Iz是横摆惯量;δ是前轮转角,δsw是转向盘转角,i是转向系统传动比;m是整车质量,ax、ay分别是车辆传感器测量纵、横向加速度。
3.根据权利要求2所述的基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,其特征在于,状态方程、观测方程离散化分别为:
其中:k为迭代次数,Δt为采样时间间隔。
4.根据权利要求1所述的基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,其特征在于,所述ICDKF对分布式电驱动汽车行驶状态参数进行估计的具体过程为:
S3.1,赋初始值:状态变量x=[γ β vx]T和误差协方差矩阵Px的初值分别为:和
S3.2,确定时间更新Sigma点集其中h为中心差分区间长度,k为迭代次数;
S3.3,时间更新:将Sigma点通过三自由度非线性车辆动力学模型离散化状态方程F(·)进行变换得到状态量Sigma点集由变换后的状态量Sigma点集计算状态一步预测和方差Pk/k-1;
S3.4,测量更新:由S3.3中得到的状态一步预测进行迭代初始化,然后进行迭代循环,得到估计状态量和误差协方差。
5.根据权利要求4所述的基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,其特征在于,所述S3.4中迭代循环的具体过程为:
a)迭代循环开始,构造测量更新Sigma点集:其中j=0,1,2…n;
b)将每个Sigma点通过三自由度非线性车辆动力学模型离散化观测方程H(·)进行变换得到观测量Sigma点集
c)由变换后的观测量Sigma点集计算一步预测和自协方差阵和互协方差阵
d)计算滤波增益
e)用标准卡尔曼滤波更新公式对下一时刻的状态量和状态量误差协方差进行更新;
f)得到估计状态量和误差协方差,迭代循环结束。
6.根据权利要求5所述的基于ICDKF的分布式电驱动汽车行驶状态参数估计算法,其特征在于,所述标准卡尔曼滤波更新公式
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610998379.9A CN106515740B (zh) | 2016-11-14 | 2016-11-14 | 基于icdkf的分布式电驱动汽车行驶状态参数估计算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610998379.9A CN106515740B (zh) | 2016-11-14 | 2016-11-14 | 基于icdkf的分布式电驱动汽车行驶状态参数估计算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106515740A CN106515740A (zh) | 2017-03-22 |
CN106515740B true CN106515740B (zh) | 2018-10-09 |
Family
ID=58351474
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610998379.9A Active CN106515740B (zh) | 2016-11-14 | 2016-11-14 | 基于icdkf的分布式电驱动汽车行驶状态参数估计算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106515740B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107144284A (zh) * | 2017-04-18 | 2017-09-08 | 东南大学 | 基于ckf滤波的车辆动力学模型辅助惯导组合导航方法 |
CN109900295B (zh) * | 2017-12-11 | 2022-12-09 | 上海交通大学 | 基于自主式传感器的车辆运动状态的检测方法及系统 |
CN108357498B (zh) * | 2018-02-07 | 2019-12-27 | 北京新能源汽车股份有限公司 | 一种车辆状态参数确定方法、装置及汽车 |
CN110197104B (zh) * | 2018-02-27 | 2022-03-29 | 杭州海康威视数字技术股份有限公司 | 基于车辆的测距方法及装置 |
CN108545081B (zh) * | 2018-03-20 | 2020-04-28 | 北京理工大学 | 基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法及系统 |
CN109159783B (zh) * | 2018-08-23 | 2020-10-09 | 北京理工大学 | 一种针对分布式电驱动履带车辆的地面参量估计方法 |
CN110988709A (zh) * | 2019-10-24 | 2020-04-10 | 延锋伟世通电子科技(南京)有限公司 | 一种用于电池管理系统的soe和sop联合估计方法 |
CN111547059A (zh) * | 2020-04-23 | 2020-08-18 | 上海大学 | 一种分布式驱动电动汽车惯性参数估计方法 |
CN111703432B (zh) * | 2020-06-28 | 2022-12-20 | 湖南大学 | 一种智能履带车辆滑动参数实时估计方法 |
CN111845775B (zh) * | 2020-07-20 | 2022-01-07 | 上海大学 | 一种分布式驱动电动汽车行驶状态与惯性参数联合估计方法 |
CN114475624A (zh) * | 2021-07-20 | 2022-05-13 | 浙江万安科技股份有限公司 | 考虑不确定性时滞的线控底盘车辆横向状态融合估计方法 |
WO2023035234A1 (zh) * | 2021-09-10 | 2023-03-16 | 华为技术有限公司 | 车辆状态参数估计方法及装置 |
CN115571156B (zh) * | 2022-09-23 | 2023-12-26 | 东南大学 | 基于传感器融合的前车横向与纵向运动状态联合估计方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004008648A2 (en) * | 2002-07-15 | 2004-01-22 | Automotive Systems Laboratory, Inc. | Road curvature estimation and automotive target state estimation system |
CN102343912B (zh) * | 2011-06-20 | 2013-09-11 | 中南大学 | 一种汽车行驶过程中的状态估计方法 |
KR101818539B1 (ko) * | 2011-08-24 | 2018-02-21 | 현대모비스 주식회사 | 차량의 차선 유지 지원 시스템 및 그 방법 |
CN104182991A (zh) * | 2014-08-15 | 2014-12-03 | 辽宁工业大学 | 一种车辆行驶状态估计方法及装置 |
CN104554271B (zh) * | 2014-12-08 | 2017-09-12 | 昆明理工大学 | 一种基于参数估计误差的路面坡度和汽车状态参数联合估计方法 |
-
2016
- 2016-11-14 CN CN201610998379.9A patent/CN106515740B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106515740A (zh) | 2017-03-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106515740B (zh) | 基于icdkf的分布式电驱动汽车行驶状态参数估计算法 | |
CN108482379B (zh) | 轮毂电机驱动车辆路面附着系数及路面坡度同步实时估算系统及方法 | |
CN106394561B (zh) | 一种车辆的纵向车速的估计方法和装置 | |
CN102673569B (zh) | 车辆状态测算装置、方法及使用该装置的车辆 | |
Cho et al. | Estimation of tire forces for application to vehicle stability control | |
CN105172793B (zh) | 自动驾驶汽车的位姿估算方法 | |
CN107016157B (zh) | 分布式驱动电动汽车路面自适应纵向车速估计系统及方法 | |
CN110341714B (zh) | 一种同时估计车辆质心侧偏角和扰动的方法 | |
CN106184225B (zh) | 分布式四驱电动车动力学控制的纵向车速估算方法 | |
CN107963126A (zh) | 一种多轴转向车辆大曲率自动驾驶转向控制方法 | |
CN105151047A (zh) | 一种汽车质心侧偏角测量方法 | |
CN108819950B (zh) | 汽车稳定性控制系统的车速估计方法及系统 | |
CN110588657B (zh) | 一种针对车辆运动状态及道路坡度的联合估计方法 | |
CN109606378A (zh) | 面向非高斯噪声环境的车辆行驶状态估计方法 | |
CN105270397B (zh) | 车辆电子稳定性控制系统稳定性控制判据的制定方法 | |
CN108216250A (zh) | 基于状态观测器的四驱电动汽车速度与道路坡度估计方法 | |
CN108241773A (zh) | 一种改进的车辆行驶状态估计方法 | |
CN107264535B (zh) | 一种基于频响特性的整车质量估计方法 | |
CN110530361A (zh) | 一种基于农业机械双天线gnss自动导航系统的转向角度估计器 | |
CN102582626A (zh) | 重型半挂车状态估计方法 | |
CN113247004A (zh) | 一种车辆质量与道路横向坡度的联合估计方法 | |
CN111006884B (zh) | 基于傅立叶变换的车轮车轴侧偏角与侧偏刚度的测量方法 | |
CN111806430B (zh) | 一种用于自动泊车的车速计算方法 | |
CN112270039A (zh) | 基于分布式异步融合的线控底盘车辆非线性状态估计方法 | |
CN112455456B (zh) | 一种智能商用车质心位置测量方法及行车安全控制系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |