Improved Vehicle Localization Based on Moving Horizon Estimation with Node Constraints
Improved Vehicle Localization Based on Moving Horizon Estimation with Node Constraints
复制标题
基于带节点约束的移动地平线估计的改进车辆定位
DOI:
10.1109/sii52469.2022.9708878
复制
发表时间:
2022
期刊:
影响因子:
--
通讯作者:
K. Sekiguchi
中科院分区:
文献类型:
--
作者:
Ryusei Toma;K. Nonaka;K. Sekiguchi
In this research, the accuracy of vehicle localization using Global Navigation Satellite System (GNSS) is improved by utilizing node constraints embedded in Moving Horizon Estimation (MHE). In the area where the satellite signal does not reach, or multipath appears, GNSS measurements will be biased and result in large localization error. In this study, GNSS, odometry, and map information are fused by MHE to address this issue. MHE incorporate constraints to improve estimation accuracy. In this study, nodes on the map are utilized as constraints to modify the estimated positions using nodes for each point without requiring a high-precision map. In addition, MHE can modify the past estimation within the horizon, which correct the series of estimated position so that they coincide with the running trajectory. Furthermore, the estimation error due to GNSS bias is corrected by estimating the bias itself using the displacement at the node. This correction is effective even after the constraint at nodes goes out of the horizon. We conducted simulations of vehicle localization in which nodes were placed on the trajectory. It was verified that the proposed method suppressed the GNSS positioning error. Therefore, MHE with nodes as constraint could improve the estimation affected by the positioning error of GNSS.