CN109466559B - 基于滞后滤波路面坡度的计算方法和装置 - Google Patents
基于滞后滤波路面坡度的计算方法和装置 Download PDFInfo
- Publication number
- CN109466559B CN109466559B CN201811544321.2A CN201811544321A CN109466559B CN 109466559 B CN109466559 B CN 109466559B CN 201811544321 A CN201811544321 A CN 201811544321A CN 109466559 B CN109466559 B CN 109466559B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- acceleration
- longitudinal
- value
- sampling period
- 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
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
- 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/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
- Vehicle Body Suspensions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种基于滞后滤波路面坡度的计算方法和装置,包括:(a)计算纵向加速度在采样周期T内的平均值;计算车辆自身加速度在采样周期T内的平均值;(b)将纵向加速度在采样周期T内的平均值减去车辆自身加速度在采样周期T内的平均值,得到车辆重力加速度纵向分量实测值;(c)将车辆重力加速度纵向分量实测值减去纵向加速度传感器的零点偏差,得到车辆重力加速度纵向分量真实值;(d)将车辆重力加速度纵向分量真实值进行滞后滤波处理,得到车辆重力加速度纵向分量;(e)计算路面的坡度值,所述坡度值等于车辆重力加速度纵向分量与重力加速度的比值。利用本发明得到的坡度值更准确,波动小,且成本低。
Description
技术领域
本发明属于汽车智能化控制技术领域,具体涉及一种基于滞后滤波路面坡度的计算方法和装置。
背景技术
目前汽车行驶工况非常复杂,智能控制的功能日益丰富。如果不知道现在汽车所处道路的准确坡度,可能会出现起步时溜坡、前冲、发动机转速上冲及上下坡速度控制不精确等问题,整车控制器中ESP(车身电子稳定系统)、EPB(电子驻车制动系统)、TCU(自动变速箱控制单元)、EMS(发动机管理系统),智能驾驶系统ACC(自适应巡航控制系统)、AEB(自动紧急制动系统)、APA(自动泊车辅助)等功能更需要精确的坡度,来实现不同坡度下的加速与制动,满足驾驶需要。
目前市场上车辆坡度计算方案靠普通的车用加速度传感器原始纵向加速度输出信号代替,但该信号在匀速行驶、加速和制动阶段波动较大无法真实反映道路的坡度状态,检测精度无法满足APA精确控制需要;而惯导IMU成本高(超过万元人民币),性能不佳,且产品未量产,无法批量推广应用。使用车载加速度和车速信息进行估算,其仅使用加权平均算法,未考虑传感器信号波动及自身零点偏差等特性,估算结果不稳定,暂无实际工程应用。
因此,有必要开发一种新的基于滞后滤波路面坡度的计算方法和装置。
发明内容
本发明的目的是提供一种估算结果准确,波动小,且成本低的基于滞后滤波路面坡度的计算方法和装置。
本发明所述的基于滞后滤波路面坡度的计算方法,包括以下步骤:
步骤1、获取车辆的纵向加速度信息;
获取车速信息,所述车速信息经微分后得到车辆自身加速度;
步骤2、根据所述纵向加速度信息和所述车速信息计算路面的坡度,具体为:
(a)计算纵向加速度在采样周期T内的平均值;
计算车辆自身加速度在采样周期T内的平均值;
(b)将纵向加速度在采样周期T内的平均值减去车辆自身加速度在采样周期T内的平均值,得到车辆重力加速度纵向分量实测值;
(c)将车辆重力加速度纵向分量实测值减去纵向加速度传感器的零点偏差,得到车辆重力加速度纵向分量真实值;
(d)将车辆重力加速度纵向分量真实值进行滞后滤波处理,得到车辆重力加速度纵向分量;
(e)计算路面的坡度值,所述坡度值等于车辆重力加速度纵向分量与重力加速度的比值。
进一步,将车辆重力加速度纵向分量真实值进行滞后滤波处理,得到车辆重力加速度纵向分量,具体为;
将所述车辆重力加速度纵向分量真实值进行两次一阶滞后滤波处理;
确认车辆是否处于静止;
若是,则进行第三次一阶滞后滤波,则输出三次后的滤波值,即得到车辆重力加速度纵向分量;
若否,则输出两次后的滤波值,即得到车辆重力加速度纵向分量。
进一步,计算纵向加速度在采样周期T内的平均值;具体为:
确定纵向加速度的采样周期为T,采样周期内的采样点的个数为k;
将k个采样点分成s等份,并分别累加后存储;
将s等份累加值求和后平均,即得到了纵向加速度在采样周期T内的平均值;
计算车辆自身加速度在采样周期T内的平均值的方法与计算纵向加速度在采样周期T内的平均值的方法相同。
进一步, 所述一阶滞后滤波的方法为:
使用和为1的两个正因子gain和1-gain,分别与本次输入值in(t)和上次的输出值out(t-1)相乘,然后相加得到本次输出值out(t),同时本次计算的out(t)更新为下一次输出的因子。
进一步,所述采样周期T为1s。
进一步,将k个采样点分成四等份。
本发明所述的基于滞后滤波路面坡度装置,包括:用于采集车辆的纵向加速度信息的纵向加速度传感器;用于采集车辆的车速信息的车速传感器;用于接收所述纵向加速度信息和车速信息的计算模块,所述计算模块被编程以便执行如本发明所述的步骤。
本发明具有以下优点:能够在车辆现有加速度传感器、车速传感器的基础上,对加速度传感器和车速传感器原始输出信号进行处理,得到的坡度值更准确,波动小,不增加额外费用,具有性价比高并且适合大面积量产的特点。
附图说明
图1为本发明的流程图;
图2为本发明纵向加速度传感器、车辆加速度1s平均值算法的流程图;
图3为本发明使用的一阶滞后滤波算法的流程图;
图4为本发明的实际使用效果。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示,所述的基于滞后滤波路面坡度的计算方法,包括以下步骤:
步骤1、获取车辆的纵向加速度信息。获取车速信息,所述车速信息经微分后得到车辆自身加速度。本实施例中,所述车辆自身加速度为车辆动力学的与车身平行方向的加速度大小。
步骤2、根据所述纵向加速度信息和所述车速信息计算路面的坡度,具体为:
(a)计算纵向加速度在采样周期T内的平均值,计算车辆自身加速度在采样周期T内的平均值。
其中,计算纵向加速度在采样周期T内的平均值的方法为:
如图2所示,确定纵向加速度的采样周期为T,采样周期内的采样点的个数为k;将k个采样点分成s等份,并分别累加后存储;将s等份累加值求和后平均,即得到了纵向加速度在采样周期T内的平均值。
本实施例中,计算车辆自身加速度在采样周期T内的平均值的方法与计算纵向加速度在采样周期T内的平均值的方法相同。
如图2所示,以下以采样周期为1s,将k个采样点分为四个等份为例进行说明:
分别求0s~0.25s、0.25s~0.5s、0.5s~0.75s和0.7s~1s各采样点之和,将四等份累加值求和后求平均值,即得到了纵向加速度和车辆自身加速度在1s内的平均值。当后一周期的传感器数据到来后,将前一周期的采样值删除,后续重复计算。
(b)将纵向加速度在采样周期T内的平均值减去车辆自身加速度在采样周期T内的平均值,得到车辆重力加速度纵向分量实测值。
(c)将车辆重力加速度纵向分量实测值减去纵向加速度传感器的零点偏差,得到车辆重力加速度纵向分量真实值。本实施例中,纵向加速度传感器的零点偏差为传感器特性。
(d)将车辆重力加速度纵向分量真实值进行滞后滤波处理,得到车辆重力加速度纵向分量;具体为:将所述车辆重力加速度纵向分量真实值进行两次一阶滞后滤波处理;确认车辆是否处于静止;若是,则进行第三次一阶滞后滤波,则输出三次后的滤波值,即得到车辆重力加速度纵向分量;若否,则输出两次后的滤波值,即得到车辆重力加速度纵向分量。本实施例中,三次滤波中每次滤波常数根据实际情况标定。
如图3所示,本实施例中,一阶滞后滤波的算法为:使用和为1的两个正因子gain和1-gain,分别与本次输入值in(t)和上次的输出值out(t-1)相乘,然后相加得到本次输出值out(t),同时本次计算的out(t)更新为下一次输出的因子。
(e)计算路面的坡度值,所述坡度值等于车辆重力加速度纵向分量与重力加速度的比值。
如图4所示,发明的实际使用效果。曲线1,曲线2,曲线3分别为道路坡度、纵向加速度传感器值和车速实测值。车辆在坡度为7°~8°的路面上测试,车辆从静止到运动再静止,实际计算道路坡度范围为0.12~0.15,转换为坡度角度为6.9~8.6°,符合设计需要。
Claims (7)
1.一种基于滞后滤波路面坡度的计算方法,其特征在于:包括以下步骤:
步骤1、获取车辆的纵向加速度信息;
获取车速信息,所述车速信息经微分后得到车辆自身加速度;
步骤2、根据所述纵向加速度信息和所述车速信息计算路面的坡度,具体为:
(a)计算纵向加速度在采样周期T内的平均值;
计算车辆自身加速度在采样周期T内的平均值;
(b)将纵向加速度在采样周期T内的平均值减去车辆自身加速度在采样周期T内的平均值,得到车辆重力加速度纵向分量实测值;
(c)将车辆重力加速度纵向分量实测值减去纵向加速度传感器的零点偏差,得到车辆重力加速度纵向分量真实值;
(d)将车辆重力加速度纵向分量真实值进行滞后滤波处理,得到车辆重力加速度纵向分量;
(e)计算路面的坡度值,所述坡度值等于车辆重力加速度纵向分量与重力加速度的比值。
2.根据权利要求1所述的基于滞后滤波路面坡度的计算方法,其特征在于:将车辆重力加速度纵向分量真实值进行滞后滤波处理,得到车辆重力加速度纵向分量,具体为;
将所述车辆重力加速度纵向分量真实值进行两次一阶滞后滤波处理;
确认车辆是否处于静止;
若是,则进行第三次一阶滞后滤波,则输出三次后的滤波值,即得到车辆重力加速度纵向分量;
若否,则输出两次后的滤波值,即得到车辆重力加速度纵向分量。
3.根据权利要求1或2所述的基于滞后滤波路面坡度的计算方法,其特征在于:计算纵向加速度在采样周期T内的平均值;具体为:
确定纵向加速度的采样周期为T,采样周期内的采样点的个数为k;
将k个采样点分成s等份,并分别累加后存储;
将s等份累加值求和后平均,即得到了纵向加速度在采样周期T内的平均值;
计算车辆自身加速度在采样周期T内的平均值的方法与计算纵向加速度在采样周期T内的平均值的方法相同。
4.根据权利要求3所述的基于滞后滤波路面坡度的计算方法,其特征在于:一阶滞后滤波的方法为:
使用和为1的两个正因子gain和1-gain,分别与本次输入值in(t)和上次的输出值out(t-1)相乘,然后相加得到本次输出值out(t),同时本次计算的out(t)更新为下一次输出的因子。
5.根据权利要求4所述的基于滞后滤波路面坡度的计算方法,其特征在于:所述采样周期T为1s。
6.根据权利要求3所述的基于滞后滤波路面坡度的计算方法,其特征在于:将k个采样点分成四等份。
7.一种基于滞后滤波路面坡度装置,其特征在于,包括:用于采集车辆的纵向加速度信息的纵向加速度传感器;用于采集车辆的车速信息的车速传感器;用于接收所述纵向加速度信息和车速信息的计算模块,所述计算模块被编程以便执行如权利要求1至6任一所述基于滞后滤波路面坡度的计算方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811544321.2A CN109466559B (zh) | 2018-12-17 | 2018-12-17 | 基于滞后滤波路面坡度的计算方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811544321.2A CN109466559B (zh) | 2018-12-17 | 2018-12-17 | 基于滞后滤波路面坡度的计算方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109466559A CN109466559A (zh) | 2019-03-15 |
CN109466559B true CN109466559B (zh) | 2020-09-08 |
Family
ID=65676295
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811544321.2A Active CN109466559B (zh) | 2018-12-17 | 2018-12-17 | 基于滞后滤波路面坡度的计算方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109466559B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110146107B (zh) * | 2019-05-05 | 2023-05-02 | 万向钱潮股份公司 | 一种epb倾角信号零点离线实时标定方法 |
CN110239554B (zh) * | 2019-06-06 | 2020-08-28 | 浙江吉利控股集团有限公司 | 一种车载路面纵向坡度实时识别方法及其装置 |
CN111824165B (zh) * | 2019-10-23 | 2021-11-19 | 长城汽车股份有限公司 | 坡度计算方法及装置 |
CN111348048B (zh) * | 2020-04-01 | 2021-12-17 | 湖南行必达网联科技有限公司 | 货车超载报警方法、装置、设备及存储介质 |
CN112249025B (zh) * | 2020-10-29 | 2022-04-08 | 华人运通(上海)云计算科技有限公司 | 车辆行驶道路纵向坡度的识别方法、装置、设备及介质 |
CN112938668B (zh) * | 2021-01-29 | 2023-03-28 | 广东卓梅尼技术股份有限公司 | 一种电梯运行高度的测量方法 |
CN113911126A (zh) * | 2021-09-30 | 2022-01-11 | 上汽通用五菱汽车股份有限公司 | 一种坡度识别方法、系统及存储介质 |
CN113911127A (zh) * | 2021-09-30 | 2022-01-11 | 上汽通用五菱汽车股份有限公司 | 一种坡度识别方法、系统及存储介质 |
CN114701507B (zh) * | 2022-03-25 | 2024-09-13 | 重庆长安汽车股份有限公司 | 车辆坡度负载的计算方法、系统、车辆及存储介质 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009040308A (ja) * | 2007-08-10 | 2009-02-26 | Denso Corp | 路面勾配推定装置、車両用制御装置、及び車両用制御システム |
CN101598549B (zh) * | 2009-07-06 | 2011-01-05 | 北京航空航天大学 | 一种车辆行驶坡度与相对高度动态估计方法 |
CN104897135A (zh) * | 2014-03-05 | 2015-09-09 | 上海通用汽车有限公司 | 一种路面坡度获取方法以及路面坡度获取系统 |
US10518757B2 (en) * | 2016-12-23 | 2019-12-31 | Robert Bosch Gbmh | Method and system for determining vehicle speed using vertical and longitudinal acceleration sensors |
-
2018
- 2018-12-17 CN CN201811544321.2A patent/CN109466559B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109466559A (zh) | 2019-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109466559B (zh) | 基于滞后滤波路面坡度的计算方法和装置 | |
CN110095635B (zh) | 一种全轮驱动车辆的纵向车速估计方法 | |
Stephant et al. | Virtual sensor: Application to vehicle sideslip angle and transversal forces | |
CN102313535B (zh) | 坡度检测方法 | |
US11650134B2 (en) | Determining tread depth using data from a tire-mounted sensor | |
Girbés-Juan et al. | Asynchronous sensor fusion of GPS, IMU and CAN-based odometry for heavy-duty vehicles | |
Wu | Experimental study on vehicle speed estimation using accelerometer and wheel speed measurements | |
CN110987470A (zh) | 一种基于模型迭代的汽车质量在线估计方法 | |
CN111038519B (zh) | 一种车载道路坡度实时估计方法 | |
US11448748B2 (en) | Systems and methods for simultaneous range-rate unwrapping and outlier removal for radar | |
CN105510223A (zh) | 用于使用自校准扭矩估计路面摩擦系数的方法和系统 | |
CN107229801B (zh) | 轮胎滚动阻力系数在线辨识方法 | |
CN111891133B (zh) | 一种适配多种路况的整车质量估算方法及系统 | |
US7110872B2 (en) | Method and device for detecting the complete stop of a vehicle | |
CN112373471B (zh) | 用于控制车辆行驶的方法、装置、电子设备和可读介质 | |
SE0950780A1 (sv) | Automatisk friktionsskattning | |
WO2019063566A1 (fr) | Procédé de détermination de la fréquence et de la phase instantanées d'un signal périodique | |
CN113428153A (zh) | 一种电动汽车的控制方法及装置 | |
CN114357794A (zh) | 一种基于改进卡尔曼滤波的公交进站停车测评方法 | |
Cheng et al. | Vehicle parameter and road grade estimation based on Kalman filter: theory and experiments | |
CN113815621A (zh) | 坡度计算方法、装置、车辆及计算机可读存储介质 | |
CN110525442B (zh) | 坡度检测方法、系统及车辆 | |
CN109987040A (zh) | 一种汽车换档信号识别方法与装置 | |
EP1940662B1 (fr) | Procede de determination de l'etat des roues d'un vehicule automobile et dispositif de mise en oeuvre | |
Ghosn et al. | A Robust Hybrid Observer for Side-slip Angle Estimation |
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 | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20190315 Assignee: CHONGQING CHANGAN NEW ENERGY AUTOMOBILE TECHNOLOGY Co.,Ltd. Assignor: Chongqing Changan Automobile Co.,Ltd. Contract record no.: X2021500000014 Denomination of invention: Calculation method and device of pavement slope based on lag filter Granted publication date: 20200908 License type: Common License Record date: 20211014 |
|
EE01 | Entry into force of recordation of patent licensing contract |