面向异步相对观测导航系统的C-SCKF 算法研究
DOI:
CSTR:
作者:
作者单位:

上海交通大学自动化与感知学院上海200240

作者简介:

通讯作者:

中图分类号:

TH701

基金项目:

国家自然科学基金(62273228)、国家自然科学基金(62403315)项目资助


Consider stochastic cloning Kalman filter for navigation systems with asynchronous relative observations
Author:
Affiliation:

School of Automation and Intelligent Sensing, Shanghai Jiao Tong University, Shanghai 200240, China

Fund Project:

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

    随机克隆卡尔曼滤波(SCKF)考虑了与相对观测相关的历史参考状态的不确定性,相比扩展卡尔曼滤波(EKF)在处理相对观测中表现出较高的精度,广泛应用于移动机器人和无人机(UAV)的状态估计等场景中。然而随着相机和激光雷达(LiDAR)等相对观测类型传感器数量的增多,SCKF中状态及协方差矩阵的维数显著增加。而矩阵求逆等运算的数据量相对于矩阵维数呈三次方增长,导致传统算法的计算复杂度大幅上升,这限制了SCKF算法在嵌入式系统中的应用。为此,提出一种改进的Consider随机克隆卡尔曼滤波(C-SCKF)算法,旨在实现多个相对观测场景下的状态高效降维与准确估计。该算法通过引入状态降维策略和Consider卡尔曼滤波(CKF)的误差更新方式,仅考虑克隆部分状态的不确定程度而不直接进行状态估计,将状态估计维数从原本随着相对观测传感器数量增加的15(N+1)维降低至固定的15维。不同于现有方法仅考虑一种相对观测,本研究推导了更为通用的SCKF表达形式,可以处理多种异步相对观测,并对比了N种相对观测情况下EKF、SCKF和C-SCKF的算法复杂度。数值仿真和实测实验结果表明,在保证多源导航精度与传统SCKF算法相当的前提下,C-SCKF算法的计算速度比传统SCKF提升了约5倍。该算法有效缓解了高维矩阵运算带来的计算量问题,更适合部署于算力及功耗资源严格受限的车载或航载嵌入式设备中。

    Abstract:

    The stochastic cloning Kalman filter (SCKF) accounts for the uncertainty of historical reference states related to relative observations. Compared with the extended kalman filter (EKF), SCKF demonstrates higher accuracy in processing relative observations and is widely applied in scenarios such as state estimation for mobile robots and unmanned aerial vehicle (UAV). However, as the number of relative observation sensors N (such as camera and LiDAR) increases, the dimensions of the state vector and covariance matrix in SCKF expand significantly. Since the computational load of operations like matrix inversion increases cubically with the matrix dimension, the computational complexity of the traditional algorithm rises drastically, which severely limits the application of the SCKF algorithm in embedded systems. To address this issue, this article proposes an improved Consider stochastic cloning Kalman filter (C-SCKF) algorithm, aiming to achieve efficient state dimensionality reduction and accurate estimation in scenarios with multiple relative observations. By introducing a state dimensionality reduction strategy and incorporating the error update mechanism of the consider Kalman filter (CKF), the proposed algorithm merely considers the uncertainty levels of the cloned states without directly estimating them. Consequently, the dimension of the state estimation is successfully reduced from 15(N+1), which originally scales with the number of relative observation sensors, to a fixed dimension of 15. Distinct from existing methods that only account for a single type of relative observation, this article derives a more generalized expression for SCKF capable of handling multiple asynchronous relative observations. Furthermore, the algorithmic complexities of EKF, SCKF, and C-SCKF are analyzed and compared under the condition of N types of relative observations. Numerical simulations and real-world experimental results demonstrate that, while maintaining a multi-source navigation accuracy comparable to that of the traditional SCKF algorithm, the computational speed of the C-SCKF algorithm is improved by approximately five times. The proposed algorithm effectively alleviates the computational burden caused by high-dimensional matrix operations and is more suitable for deployment on vehicle-mounted or airborne embedded devices with strict constraints computing power and power consumption.

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

薛博文,朱茂然,韩佳乐,张弘宇,武元新.面向异步相对观测导航系统的C-SCKF 算法研究[J].仪器仪表学报,2026,47(7):278-291

复制
分享
相关视频

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