基于切向量拟合的连续体机械臂多 IMU 形态估计
DOI:
CSTR:
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

TP241. 3 TH89

基金项目:

江苏省农业科技自主创新资金项目(CX(24)1023)、中央高校基本科研业务费专项(2024301002)资助


Shape estimation of continuum robots with multiple IMUs based on tangent vector fitting
Author:
Affiliation:

Fund Project:

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

    中心杆构型的连续体机械臂,主干是一根连续介质杆,缺少传统机械臂的关节结构,因此形态反馈一直是难以解决的问 题。 目前,基于多 IMU 的形态测量方法大多依赖分段常曲率假设,但这种假设在机械臂受到外部负载作用时无法满足,从而影 响形态估计的准确性。 为了解决这一问题,提出了一种基于切向量拟合的连续体机械臂多 IMU 形态估计算法。 该算法基于 Cosserat 杆理论对连续体机械臂进行数学建模,能够更准确地描述其变形行为。 通过误差状态卡尔曼滤波对多个测量位置的形 态进行估计,并求解出每个位置的切向量。 接下来,采用 B 样条方法对各个位置离散的切向量进行拟合,获取以弧长为自变量 的切向量函数。 最后,通过对连续变化的切向量函数进行积分,完成形态估计。 实验表明,该算法在动态轨迹和静态负载下均 能实现高精度的形态估计,尤其在负载引起的形态变化较为显著时,算法表现出较强的鲁棒性和稳定性。 与传统的基于分段常 曲率假设的方法相比,所提算法在末端位置的定位精度和形态重构的准确性方面都有显著提升。 在负载较大的情况下,形态估 计误差相比现有方法降低了 50% 以上,证明了其在复杂应用场景中的优越性。

    Abstract:

    The continuum robotic arm with a central backbone configuration utilizes a single continuous medium rod as its main structure, lacking the joint mechanisms found in traditional robotic arms. This design makes shape feedback a long-standing challenge. Currently, most shape measurement methods based on multiple IMUs rely on the piecewise constant curvature assumption. However, this assumption often fails when the robotic arm is subjected to external loads, leading to reduced accuracy in shape estimation. To address this issue, this paper proposes a multi-IMU shape estimation algorithm for continuum robotic arms based on tangent vector fitting. The algorithm employs Cosserat rod theory to mathematically model the continuum robotic arm, enabling a more accurate description of its deformation behavior. The shape at multiple measurement points is estimated using error-state Kalman filtering, and the tangent vector at each point is calculated. Subsequently, B-spline fitting is applied to the discrete tangent vectors to obtain a continuous tangent vector function with arc length as the independent variable. Finally, by integrating this continuously varying tangent vector function, the shape estimation is completed. Experimental results demonstrate that the algorithm achieves high-precision shape estimation under both dynamic trajectories and static loads, particularly when significant shape changes are induced by external loads. The algorithm exhibits strong robustness and stability. Compared to traditional methods based on the piecewise constant curvature assumption, the proposed algorithm significantly improves the positioning accuracy at the end-effector and the accuracy of shape reconstruction. Under high-load conditions, the shape estimation error is reduced by more than 50% compared to existing methods, proving its superiority in complex application scenarios.

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

许立松,马国梁,邹文成,郭 健,于 睿.基于切向量拟合的连续体机械臂多 IMU 形态估计[J].仪器仪表学报,2025,46(1):363-370

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2025-04-08
  • 出版日期:
文章二维码