Joint Estimation of Position and Attitude for Intelligent Vehicles by Fusing Delayed Visual Measurements
Zipeng Li,Yafeng Guo,Jun Wang
DOI: https://doi.org/10.1016/j.jfranklin.2023.04.025
IF: 4.246
2023-05-06
Journal of the Franklin Institute
Abstract:Accurate position and attitude information is an important basis for normal driving of intelligent vehicles. In this paper, we investigate the estimation of position and attitude states for intelligent vehicles with low cost scheme. The low cost GNSS, camera, and proprioceptive sensors equipped by mass-produced vehicle are fused to estimate the states. The visual measurements adopted in this paper are based on the lateral distance and deflection angle to road features such as lane lines or curbs, which are generated more frequently than some other semantic features such as traffic lights, and leads to broader application scenario. Moreover, it is easier to implement compared with geometrical feature matching methods, since it only needs a simple prior map while latter needs large maps containing many high precision features. The visual measurements is often with large time delay due to negligible processing time. In order to fuse delayed measurements, a state-augmentation technique is adopted for the estimator design. The performance of the proposed method is evaluated by professional simulation software CarMaker, and shows that the incorporation of road features based visual measurement can effectively improve the position and attitude estimation accuracy by reducing the lateral position and yaw angle estimation error.
automation & control systems,engineering, electrical & electronic, multidisciplinary,mathematics, interdisciplinary applications