运动与环境感知引导的自适应滑窗LiDAR-IMU 融合定位方法
DOI:
CSTR:
作者:
作者单位:

1.西北工业大学电子信息学院西安710114; 2.中国科学院空天信息创新研究院北京100094; 3.中国科学院大学电子电气与通信工程学院北京100049; 4.中国人民解放军火箭军工程大学西安710025

作者简介:

通讯作者:

中图分类号:

TH761TP242

基金项目:

智控实验室开放基金(2024-ZKSYS-KF02-02)项目资助


An adaptive sliding window LiDAR-IMU fusion localization method guided by motion and environment perception
Author:
Affiliation:

1.School of Electronics and Information, Northwestern Polytechnical University, Xi′an 710114, China; 2.Aerospace Information Research Institute, Chinese Academy of Sciences, Beijing 100094, China; 3.School of Electronic, Electrical and Communication Engineering, University of Chinese Academy of Sciences, Beijing 100049, China; 4.Rocket Force University of Engineering, Xi′an 710025, China

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    滑动窗口因子图优化因兼顾计算效率与估计精度,已成为激光雷达与惯性融合定位与建图系统中的关键优化框架。然而,现有滑动窗口策略大多采用固定窗口长度或基于经验规则的动态调整机制,难以有效适应载体运动状态及环境观测质量的动态变化,在剧烈运动或退化环境下易引发窗口内观测信息分布失衡,进而导致位姿估计精度下降,甚至造成优化发散。针对上述问题,提出了一种面向运动状态与环境观测联合感知的自适应滑动窗口优化方法。该方法利用惯性测量单元预积分残差的卡方统计量实时刻画载体运动状态,实现对急加速、急转弯等运动突变工况的准确识别。基于克拉美-罗下界理论构建环境观测质量评价模型,通过信息矩阵对激光点云配准过程中的位姿可观测性及估计精度进行定量评估。进一步融合运动状态与环境观测质量评价结果,设计联合感知驱动的滑动窗口自适应调节策略,并结合多状态边缘化机制,在窗口规模动态变化过程中保持历史信息的连续性与优化模型的一致性。实车测试结果表明,所提方法的定位均方根误差(RMSE)相较于采用固定滑动窗口策略的误差降低了57.5%,验证了所提自适应滑动窗口策略能够有效抑制误差累积,显著提升系统定位精度。

    Abstract:

    Sliding window factor graph optimization has become a key optimization framework for LiDAR-inertial simultaneous localization and mapping systems because it provides an effective balance between computational efficiency and estimation accuracy. However, existing sliding window strategies generally employ either a fixed window size or heuristic adjustment mechanisms, making them incapable of effectively adapting to dynamic changes in platform motion and environmental observation quality. Consequently, under aggressive motions or in geometrically degenerate environments, the observation distribution within the optimization window becomes imbalanced, resulting in degraded pose estimation accuracy and even optimization divergence. To address these challenges, this paper proposes an adaptive sliding window optimization method driven by the joint perception of platform motion and environmental observations. Specifically, the Chi-square statistic of inertial measurement unit pre-integration residuals is utilized to characterize the platform motion state in real time, enabling accurate detection of motion mutations such as rapid acceleration and sharp turns. Furthermore, an environmental observation quality evaluation model is established based on the Cram-r-Rao Lower Bound, where the information matrix is employed to quantitatively evaluate the pose observability and estimation accuracy of LiDAR point cloud registration. The motion-state assessment and environmental observation evaluation are further integrated to develop a joint perception-driven adaptive sliding window adjustment strategy. In addition, a multi-state marginalization mechanism is introduced to preserve historical information and maintain the consistency of the optimization model during dynamic window resizing. Real-world experimental results demonstrate that the proposed method reduces the root mean square error (RMSE) of localization by 57.5% compared with the conventional fixed sliding window strategy, effectively suppressing error accumulation and significantly improving the localization accuracy of the system.

    参考文献
    相似文献
    引证文献
引用本文

纪新春,曾瑞琪,魏东岩,李乔,周德云.运动与环境感知引导的自适应滑窗LiDAR-IMU 融合定位方法[J].仪器仪表学报,2026,47(8):374-387

复制
分享
相关视频

文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2026-10-29
  • 出版日期:
文章二维码