基于平滑迭代ESKF的无人船位姿估计算法
DOI:
CSTR:
作者:
作者单位:

江苏大学电气信息工程学院 镇江 212013

作者简介:

通讯作者:

中图分类号:

TN98;TP391

基金项目:

中国高校产学研创新基金-无人集群协同智能项目(2021ZYB02002)资助


Algorithm for estimating the pose of USV based on smooth iterative ESKF
Author:
Affiliation:

School of Electrical and Information Engineering, Jiangsu University,Zhenjiang 212013, China

Fund Project:

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

    针对小型无人船易受到水面复杂环境影响及自身低频振动干扰,导致位姿估计精度低,无法提供可靠有效信息等问题,提出一种基于平滑迭代误差卡尔曼滤波的无人船位姿估计算法。在低速工况下,利用加速度计对纵摇角与横摇角进行补偿修正;在微机电系统(MEMS)传感器数据融合环节采用改进固定区间平滑算法,使用下一时刻新息对误差状态变量进行反向平滑修正的同时,进行时间反向逆推修正,减少低频线振动对有效信号的干扰;采用平滑估计值对量测值进行预测修正,每一时刻新息可反复迭代修正估计值和量测值,以提高整体位姿估计精度。实验结果表明,相较于误差状态卡尔曼滤波,平滑迭代误差状态卡尔曼滤波算法,横摇角、纵摇角和艏摇角均方根误差分别减少0.762 1°、1.818 8°、0.340 5°;正常水面航行情况下,东向、北向、天向速度均方根误差分别减少0.402 3、0.239 4、0.116 5 m/s;东向、北向、天向位置均方根误差分别减少0.148 4、0.258 9、0.083 2 m,能够为无人船提供更为精准的位姿信息。

    Abstract:

    To address the low pose estimation accuracy and unreliable information output in small unmanned surface vessels caused by complex water surface environments and low-frequency vibration interference, this paper proposes a pose estimation algorithm based on smoothed iterated error-state Kalman filtering. Under low-speed operating conditions, the algorithm employs an accelerometer to compensate and correct pitch and roll angles. In the data fusion process of micro-electro-mechanical system (MEMS) sensors, an improved fixed-interval smoothing algorithm is adopted, which utilizes the innovation from the next time step to perform backward smoothing corrections on the error state variables while conducting time-reversed inverse corrections, thereby reducing the interference of low-frequency linear vibrations on effective signals. The smoothed estimates are used to predict and correct the measurement values, with each time step′s innovation iteratively refining both the estimated and measured values to enhance overall pose estimation accuracy.Experimental results demonstrate that compared to the standard error-state Kalman filter,the proposed SIESKF algorithm reduces the root mean square errors (RMSEs) of roll, pitch, and yaw angles by 0.762 1°, 1.818 8° and 0.340 5°, respectively. Under normal water surface navigation conditions, the RMSEs of eastward, northward, and upward velocities decrease by 0.402 3, 0.239 4 and 0.116 5 m/s, respectively. Similarly, the RMSEs of eastward, northward, and upward positions are reduced by 0.148 4, 0.258 9 and 0.083 2 m. This algorithm can provide more precise pose information for USVs.

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

刘超,李淑青,沈跃,刘慧.基于平滑迭代ESKF的无人船位姿估计算法[J].电子测量技术,2026,49(7):64-73

复制
分享
相关视频

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

重要通知公告

①《电子测量技术》期刊收款账户变更公告