arXiv:2604.15619cs.RO2026-04

用因子图+低维参数化,实现连续体机器人的高精度形状重建。

Factor Graph-Based Shape Estimation for Continuum Robots via Magnus Expansion

论文配图:Factor Graph-Based Shape Estimation for Continuum Robots via Magnus Expansion
图 1 · 摘自论文原文
  • 在因子图中嵌入几何可变应变参数化,压缩状态维度。
  • 三种测量配置下位置误差均低于2毫米,方向误差降低六倍。
  • 适合需要精准控制与不确定性量化场景的机器人系统设计。

从稀疏、噪声较大的传感器数据中重构连续体机械臂的形状是一项挑战,因其具有无限维特性。现有方法通常在参数化方法(紧凑状态表示但缺乏概率结构)与基于因子图的柯塞拉杆推断(提供严谨不确定性量化,但状态维度随空间离散化增长)之间权衡。本文结合两者优势,在因子图框架内估计低维几何可变应变(GVS)参数化的系数。通过应变场的马格努斯展开推导出一种新型运动学因子,以闭式形式将GVS应变系数与主干姿态变量关联起来,作为先验约束。该方法生成紧凑的状态向量,可直接用于模型化控制,同时保持因子图推理的模块性、概率处理能力与计算效率。在0.4米长的肌腱驱动连续体机器人上进行仿真评估,三种测量配置下均实现低于2毫米的平均位置误差;当仅有位置测量时,方向误差相比高斯过程回归基线降低六倍。

原文摘要 · Abstract (English)

Reconstructing the shape of continuum manipulators from sparse, noisy sensor data is a challenging task, owing to the infinite-dimensional nature of such systems. Existing approaches broadly trade off between parametric methods that yield compact state representations but lack probabilistic structure, and Cosserat rod inference on factor graphs, which provides principled uncertainty quantification at the cost of a state dimension that grows with the spatial discretization. This letter combines the strength of both paradigms by estimating the coefficients of a low-dimensional Geometric Variable Strain (GVS) parameterization within a factor graph framework. A novel kinematic factor, derived from the Magnus expansion of the strain field, encodes the closed-form rod geometry as a prior constraint linking the GVS strain coefficients to the backbone pose variables. The resulting formulation yields a compact state vector directly amenable to model-based control, while retaining the modularity, probabilistic treatment and computational efficiency of factor graph inference. The proposed method is evaluated in simulation on a 0.4 m long tendon-driven continuum robot under three measurement configurations, achieving mean position errors below 2 mm for all three scenarios and demonstrating a sixfold reduction in orientation error compared to a Gaussian process regression baseline when only position measurements are available.

连续体机器人因子图形状估计姿态重建

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。