基于误差模型的车辆位姿估计与高程地图构建OA
Vehicle pose estimation and elevation mapping based on error model
在多轴应急救援车辆的车前高程地图重建中,激光雷达的测量噪声降低车辆位姿估计精度,进一步导致重建的高程地图失真.针对此问题,提出了一种基于误差模型的车辆位姿估计与高程地图构建方法,建模了从状态估计到地图构建的协方差传播机制;基于此误差模型,优化了迭代误差卡尔曼滤波器的惯性测量单元状态先验与激光雷达观测模型的融合权重,提升了车辆位姿估计精度.基于改进的位姿估计方法和高程不确定性模型,实现了高程信息的融合与更新.公开数据集、仿真平台与实车实验的验证结果表明,所提出的方法降低了位姿估计误差,提升了高程重建精度.
In the forward elevation map reconstruction of multi-axle emergency rescue vehicles,measurement noises from the LiDAR reduced the accuracy of vehicle pose estimation,further leading to distortions in the elevation map.To address this issue,a vehicle pose estimation and elevation mapping method based on an uncertainty error model was proposed,which provided a modeling of the covariance propagation mechanism from state estimation to map construction.Based on this uncertainty error model,the fusion weight between the state prior of inertial-measurement-unit and the LiDAR observation model in the iterated error state Kalman filter was optimized,thereby enhancing the accuracy of vehicle pose estimation.Utilizing the improved pose estimation method and the elevation uncertainty model,the fusion and update of elevation information were achieved.Validation results on public datasets,simulation platforms,and real vehicle experiments show that the proposed method reduces the pose estimation error and improves the elevation mapping accuracy.
师小波;赵丁选;陈慧宁;王晓冬;张万臣;李灵锋;李佳奇
燕山大学 机械工程学院,河北 秦皇岛 066004||河北建材职业技术学院 信息工程系,河北 秦皇岛 066004燕山大学 机械工程学院,河北 秦皇岛 066004河北建材职业技术学院 信息工程系,河北 秦皇岛 066004||燕山大学 电气工程学院,河北 秦皇岛 066004河北建材职业技术学院 机电工程系,河北 秦皇岛 066004||燕山大学 车辆与能源学院,河北 秦皇岛 066004河北建材职业技术学院 信息工程系,河北 秦皇岛 066004||燕山大学 电气工程学院,河北 秦皇岛 066004河北建材职业技术学院 机电工程系,河北 秦皇岛 066004||燕山大学 车辆与能源学院,河北 秦皇岛 066004太原科技大学 机械工程学院,山西 太原 030024
信息技术与安全科学
点云噪声模型协方差传播位姿估计卡尔曼滤波高程地图
point cloud noise modelcovariance propagationpose estimationKalman filterelevation mapping
《燕山大学学报》 2026 (5)
403-416,14
国家自然科学基金资助项目(U24A6008)河北省自然科学基金资助项目(E2024203257)秦皇岛市科学技术研究与发展计划资助项目(20251A145)
评论