基于双卡尔曼滤波及概率最近邻数据关联的道路坡度实时估计

doi:10.3901/JME.2022.16.258

机械工程学报 ›› 2022, Vol. 58 ›› Issue (16): 258-269.doi: 10.3901/JME.2022.16.258

扫码分享

基于双卡尔曼滤波及概率最近邻数据关联的道路坡度实时估计

冯继豪¹, 秦大同¹, 刘永刚¹, 王鑫²

1. 重庆大学机械传动国家重点实验室重庆 400044;
2. 重庆长安汽车股份有限公司重庆 400023

收稿日期:2021-06-01 修回日期:2022-05-16 出版日期:2022-08-20 发布日期:2022-11-03
通讯作者: 秦大同(通信作者)，男，1956年出生，博士，教授，博士研究生导师。主要研究方向为车辆动力传动与控制。E-mail：dtqin@cqu.edu.cn
作者简介:冯继豪，男，1990年出生，博士研究生。主要研究方向为车辆动力传动与智能控制。E-mail：ifengjh@cqu.edu.cn
基金资助:
国家自然科学基金资助项目(U1764259)

Real Time Estimation of Road Slope Based on Dual Kalman Filter and Probabilistic Nearest Neighbor Data Association

FENG Jihao¹, QIN Datong¹, LIU Yonggang¹, WANG Xin²

1. State Key Laboratory of Mechanical Transmission, Chongqing University, Chongqing 400044;
2. Chongqing Changan Automobile Co., Ltd., Chongqing 400023

Received:2021-06-01 Revised:2022-05-16 Online:2022-08-20 Published:2022-11-03

摘要/Abstract

摘要： 道路坡度的估计对于车辆的精确控制、行驶环境的构建分析具有重要意义。在以往的坡度估计中未考虑坡度变化率，估计值难以实时跟随道路坡度的变化。同时基于单一估计方法的估计结果会受到刹车、换档、急加速等车辆状态的影响，难以保证坡度估计的可靠性及准确性。因此，提出了一种基于双卡尔曼滤波及概率最近邻数据关联滤波器的道路坡度估计方法。根据不同的车辆状态将基于动力学与基于运动学的两种子估计坡度值进行全局融合，避免单个子估计坡度值的误差。同时，对于每种子估计方法提出了一种基于双(无迹)卡尔曼滤波的坡度变化率及坡度分层估计算法。仿真和试验结果表明，所提出的子估计方法能够更好地跟随道路坡度的变化，提高估计精度。而全局融合方法能够在子估计方法的基础上进一步提高估计精度，避免某一子估计值的较大误差，提高坡度估计的准确性及可靠性。

关键词: 坡度估计, 双卡尔曼滤波, 概率最近邻数据关联, 估计融合

Abstract: The estimation of road slope is of great significance for the accurate control of vehicles and the construction and analysis of driving environment. In the previous slope estimation, the slope change rate is not considered, so it is difficult for the estimated value to follow the change of road slope in real time. And, the estimation results based on a single estimation method will be affected by braking, shifting, rapid acceleration and other vehicle states, so it is difficult to ensure the reliability and accuracy of slope estimation. Therefore, a road slope estimation method based on dual Kalman filter and probabilistic nearest neighbor data association filter is proposed. According to different vehicle states, the two sub estimated slope values based on dynamics and kinematics are fused globally to avoid the error of single sub-estimated slope value. And, for each sub estimation method, a slope change rate and slope hierarchical estimation algorithm based on dual (unscented) Kalman filter is proposed. Simulation and experimental results show that the proposed sub-estimation method can better follow the change of road slope and improve the estimation accuracy. The global fusion method can further improve the estimation accuracy on the basis of the sub-estimation method, avoid the large error of a sub estimation, and improve the accuracy and reliability of slope estimation.

Key words: slope estimation, dual Kalman filter, probabilistic nearest neighbor data association, estimation fusion

中图分类号:

U461

冯继豪, 秦大同, 刘永刚, 王鑫. 基于双卡尔曼滤波及概率最近邻数据关联的道路坡度实时估计[J]. 机械工程学报, 2022, 58(16): 258-269.

FENG Jihao, QIN Datong, LIU Yonggang, WANG Xin. Real Time Estimation of Road Slope Based on Dual Kalman Filter and Probabilistic Nearest Neighbor Data Association[J]. Journal of Mechanical Engineering, 2022, 58(16): 258-269.

参考文献

[1] LEI Yulong, FU Yao, LIU Ke, et al. Vehicle mass and road grade estimation based on extended Kalman filter[J]. Transactions of the Chinese Society for Agricultural Machinery, 2014, 45(11): 9-14. 雷雨龙, 付尧, 刘科, 等. 基于扩展卡尔曼滤波的车辆质量与道路坡度估计[J]. 农业机械学报, 2014, 45(11): 9-14.
[2] SUN Y, LI L, YAN B, et al. A hybrid algorithm combining EKF and RLS in synchronous estimation of road grade and vehicle mass for a hybrid electric bus[J]. Mechanical Systems and Signal Processing, 2016, 68-69: 416-430.
[3] DAI Zhuo, WU Guangqiang. Estimation method of road slope and vehicle mass based on vehicle dynamics[J]. Automobile Technology, 2018(1): 20-24. 戴卓, 吴光强. 基于车辆动力学的道路坡度与整车质量估计[J]. 汽车技术, 2018(1): 20-24.
[4] VAHIDI A, STEFANOPOULOU A, PENG H. Recursive least squares with forgetting for online estimation of vehicle mass and road grade: Theory and experiments[J]. Vehicle System Dynamics, 2005, 43(1): 31-55.
[5] MCINTYRE M L, GHOTIKAR T J, VAHIDI A, et al. A two-stage Lyapunov-based estimator for estimation of vehicle mass and road grade[J]. IEEE Transactions on Vehicular Technology, 2009, 58(7): 3177-3185.
[6] MAHYUDDIN M N, NA J, HERRMANN G, et al. Adaptive observer-based parameter estimation with application to road gradient and vehicle mass estimation[J]. IEEE Transactions on Industrial Electronics, 2014, 61(6): 2851-2863.
[7] ZHANG Y, ZHANG Y, AI Z, et al. A cross iteration estimator with base vector for estimation of electric mining haul truck's mass and road grade[J]. IEEE Transactions on Industrial Informatics, 2018, 14(9): 4138-4148.
[8] LI B, ZHANG J, DU H, et al. Two-layer structure based adaptive estimation for vehicle mass and road slope under longitudinal motion[J]. Measurement, 2016, 95: 439-455.
[9] HAO Shengqiang, LUO Peipei, XI Junqiang. Estimation of vehicle mass and road slope based on steady-state Kalman filter[J]. Automotive Engineering, 2018, 40(9): 1062-1067, 1075. 郝胜强, 罗培培, 席军强. 基于稳态卡尔曼滤波的车辆质量与道路坡度估计[J]. 汽车工程, 2018, 40(9): 1062-1067, 1075.
[10] LIN Nan, SHI Shuming, MA Li, et al. Road grade estimation with grade change rate information. Journal of Jilin University, 2016, 46(6): 1845-1850. 林楠, 施树明, 马力, 等. 含坡度变化率信息的道路坡度估计[J]. 吉林大学学报, 2016, 46(6): 1845-1850.
[11] KIM S, SHIN K, YOO C, et al. Development of algorithms for commercial vehicle mass and road grade estimation[J]. International Journal of Automotive Technology, 2017, 18(6): 1077-1083.
[12] KLOMP M, GAO Y, BRUZELIUS F. Longitudinal velocity and road slope estimation in hybrid electric vehicles employing early detection of excessive wheel slip[J]. Vehicle System Dynamics, 2014, 52(Suppl. 1): 172-188.
[13] CHU Wenbo, LUO Yugong, LUO Jian, et al. Vehicle mass and road slope estimates for electric vehicles[J]. Journal of Tsinghua University, 2014, 54(6): 724-728. 褚文博, 罗禹贡, 罗剑, 等. 电驱动车辆的整车质量与路面坡度估计[J]. 清华大学学报, 2014, 54(6): 724-728.
[14] RAN Xun, LI Liang, ZHAO Xun, et al. Real-time recognition algorithm of longitudinal road slope based on vehicle dynamics and acceleration sensor information[J]. Journal of Mechanical Engineering, 2016, 52(18): 98-104. 冉旭, 李亮, 赵洵, 等. 基于汽车动力学与加速度传感信息的纵向坡度实时识别算法[J]. 机械工程学报, 2016, 52(18): 98-104.
[15] YONG Wenliang, GUAN Xin, WANG Bo, et al. Identification algorithm of longitudinal road slope based on multi-sensor data fusion filtering[J]. Journal of Mechanical Engineering, 2018, 54(14): 116-124. 雍文亮, 管欣, 王博, 等. 基于多传感数据融合滤波的纵向坡度识别算法[J]. 机械工程学报, 2018, 54(14): 116-124.
[16] JO K, KIM J SUNWOO M. Real-time road-slope estimation based on integration of onboard sensors with GPS using an IMMPDA Filter[J]. IEEE Transactions on Intelligent Transportation Systems, 2013, 14(4): 1718- 1732.
[17] JAUCH J, MASINO J, STAIGER T, et al. Road grade estimation with vehicle-based inertial measurement unit and orientation filter[J]. IEEE Sensors Journal, 2018, 18(2): 781-789.
[18] SAHLHOLM P, JOHANSSON K H. Road grade estimation for look-ahead vehicle control using multiple measurement runs[J]. Control Engineering Practice, 2010, 18(11): 1328-1341.
[19] YU Zhingsheng. Automobile throry[M]. 6th ed. Beijing: China Machine Press, 2018. 余志生. 汽车理论[M]. 6版. 北京: 机械工业出版社, 2018.
[20] WANG Wangyu. Automobile design[M]. 4th ed. Beijing: China Machine Press, 2006. 王望予. 汽车设计[M]. 4版. 北京: 机械工业出版社, 2004.
[21] JIN Xianjian, YANG Junpeng, YIN Guodong, et al. Combined state and parameter observation of distributed drive electric vehicle via dual unscented Kalman filter[J]. Journal of Mechanical Engineering, 2019, 55(22): 93-102. 金贤建, 杨俊朋, 殷国栋, 等. 分布式驱动电动汽车双无迹卡尔曼滤波状态参数联合观测[J]. 机械工程学报, 2019, 55(22): 93-102.
[22] SONG Yitong, SHU Hongyu, CHEN Xianbao, et al. State and parameters estimation for distributed drive electric vehicle based on unscented Kalman filter[J]. Journal of Mechanical Engineering, 2020, 56(16): 204-213. 宋义彤, 舒红宇, 陈仙宝, 等. 分布式电动汽车状态与参数无迹卡尔曼滤波估计[J]. 机械工程学报, 2020, 56(16): 204-213.
[23] SONG T, LEE D, RYU J. A probabilistic nearest neighbor filter algorithm for tracking in a clutter environment[J]. Signal Processing, 2005, 85(10): 2044-2053.
[24] SONG T L, DONG G L. A probabilistic nearest neighbor filter algorithm form validated measurements[J]. IEEE Transactions on Signal Processing, 2006, 54(7): 2797-2802.

基于双卡尔曼滤波及概率最近邻数据关联的道路坡度实时估计

Real Time Estimation of Road Slope Based on Dual Kalman Filter and Probabilistic Nearest Neighbor Data Association

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 2

编辑推荐

Metrics

本文评价

[1]	赵治国, 李航宇, 雷丹. 干式DCT离合器无刷直流作动电机双卡尔曼滤波故障诊断[J]. 机械工程学报, 2018, 54(2): 138-149.
[2]	戴海峰;孙泽昌;魏学哲. 利用双卡尔曼滤波算法估计电动汽车用锂离子动力电池的内部状态[J]. , 2009, 45(6): 95-101.