Adaptive joint estimates of vehicle mass and road grades for small acceleration driving scenarios
SUN Enxin1, YIN Yuming2, XIN Zhe1, LI Shengbo3, HE Jugang4, KONG Zhouwei4, LIU Xiupeng4
1. College of Engineering, China Agricultural University, Beijing 100083, China; 2. College of Mechanical Engineering, Zhejiang University of Technology, Hangzhou 310023, China; 3. Department of Automotive Engineering, Tsinghua University, Beijing 100084, China; 4. Chongqing Chang'an Automobile Co., Ltd., Chongqing 400023, China
Abstract:Vehicle mass and the road grade are key input parameters for automated vehicle decision and control algorithms. These two parameters are difficult to know accurately, but are tightly coupled for small acceleration driving scenarios with small inertias. The accuracy and convergence speed of existing estimation algorithms need to be further improved. A vehicle dynamics model is used here with an adaptive unscented Kalman filter (AUKF) algorithm for rapid, accurate joint estimates of the vehicle mass and road grade during small acceleration scenarios. The prediction model has a large initial mass noise with an adaptive shrink coefficient designed to adjust the prediction error covariance matrices. The adaptive shrink coefficient is related to the estimation result and the prediction error covariance matrices. Simulations and vehicle tests for various initial conditions show that the AUKF algorithm can accurately estimate the vehicle mass and road grade with an estimated vehicle mass error of less than 3% and a root-mean-square error in the road grade of less than 0.4°. In addition, the AUKF algorithm gives better convergence speeds for the vehicle mass and road grade estimates with longitudinal accelerations less than 0.3 m/s2 than the traditional UKF algorithm. When the initial mass error is within 40%, the estimated mass error converges to less than 3% within 10 seconds.
孙恩鑫, 殷玉明, 辛喆, 李升波, 何举刚, 孔周维, 刘秀鹏. 微小加速度下汽车质量-道路坡度自适应估计[J]. 清华大学学报(自然科学版), 2022, 62(1): 125-132.
SUN Enxin, YIN Yuming, XIN Zhe, LI Shengbo, HE Jugang, KONG Zhouwei, LIU Xiupeng. Adaptive joint estimates of vehicle mass and road grades for small acceleration driving scenarios. Journal of Tsinghua University(Science and Technology), 2022, 62(1): 125-132.
[1] 李升波, 关阳, 侯廉, 等. 深度神经网络的关键技术及其在自动驾驶领域的应用[J]. 汽车安全与节能学报, 2019, 10(2):119-145. LI S B, GUAN Y, HOU L, et al. Key technique of deep neural network and its applications in autonomous driving[J]. Journal of Automotive Safety and Energy, 2019, 10(2):119-145. (in Chinese) [2] WANG G Y, LI S B. A novel longitudinal speed estimator for fully automation ground vehicle on cornering maneuver[C]//2009 International Conference on Artificial Intelligence and Computational Intelligence. Shanghai, China:IEEE Press, 2009:433-437. [3] XU S B, LI S E, CHENG B, et al. Instantaneous feedback control for a fuel-prioritized vehicle cruising system on highways with a varying slope[J]. IEEE Transactions on Intelligent Transportation Systems, 2017, 18(5):1210-1220. [4] LI S E, GUO Q Q, XU S B, et al. Performance enhanced predictive control for adaptive cruise control system considering road elevation information[J]. IEEE Transactions on Intelligent Vehicles, 2017, 2(3):150-160. [5] KIM I, KIM H, BANG J, et al. Development of estimation algorithms for vehicle's mass and road grade[J]. International Journal of Automotive Technology, 2013, 14(6):889-895. [6] KIM D, CHOI S B, CHOI M. Integrated vehicle mass estimation for vehicle safety control using the recursive least-squares method and adaptation laws[J]. Proceedings of the Institution of Mechanical Engineers, Part D:Journal of Automobile Engineering, 2015, 229(1):14-24. [7] ZHENG H Y, MA S N, LIU Y H. Vehicle braking force distribution with electronic pneumatic braking and hierarchical structure for commercial vehicle[J]. Proceedings of the Institution of Mechanical Engineers, Part I:Journal of Systems and Control Engineering, 2018, 232(4):481-493. [8] KAROSHI P, AGER M, SCHABAUER M, et al. Robust and numerically efficient estimation of vehicle mass and road grade[C]//Advanced Microsystems for Automotive Applications 2017. Cham, Switzerland:Springer International Publishing, 2018:87-100. [9] KIDAMBI N, HARNE R L, FUJII Y, et al. Methods in vehicle mass and road grade estimation[J]. SAE International Journal of Passenger Cars-Mechanical Systems, 2014, 7(3):981-991. [10] REZAEIAN A, ZARRINGHALAM R, FALLAH S, et al. Cascaded dual extended Kalman filter for combined vehicle state estimation and parameter identification[R]. Massachusetts, America:Harvard University Press, 2013. [11] 褚文博, 罗禹贡, 罗剑, 等. 电驱动车辆的整车质量与路面坡度估计[J]. 清华大学学报(自然科学版), 2014, 54(6):724-728. CHU W B, LUO Y G, LUO J, et al. Vehicle mass and road slope estimates for electric vehicles[J]. Journal of Tsinghua University (Science and Technology), 2014, 54(6):724-728. (in Chinese) [12] 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. [13] KIDAMBI N, PIETRON G M, BOESCH M, et al. Accuracy and robustness of parallel vehicle mass and road grade estimation[J]. SAE International Journal of Vehicle Dynamics, Stability, and NVH, 2017, 1(2):317-325. [14] LIU C, LI S E, HEDRICK J K. Measurement dissemination-based distributed Bayesian filter using the latest-in-and-full-out exchange protocol for networked unmanned vehicles[J]. IEEE Transactions on Industrial Electronics, 2017, 64(11):8756-8766. [15] LIU C, EBEN LI S, YANG D G, et al. Distributed Bayesian filter using measurement dissemination for multiple unmanned ground vehicles with dynamically changing interaction topologies[J]. Journal of Dynamic Systems, Measurement, and Control, 2018, 140(3):030903. [16] ANDERSON B D O, MOORE J B. Optimal filtering[M]. Newyork, USA:Courier Corporation, 2012. [17] LI S E, LI G F, YU J Y, et al. Kalman filter-based tracking of moving objects using linear ultrasonic sensor array for road vehicles[J]. Mechanical Systems and Signal Processing, 2018, 98:173-189.