cs.ROOct 1, 2025

A Stochastic Framework for Continuous-Time State Estimation of Continuum Robots

Authors: Spencer Teetaert, Sven Lilge, Jessica Burgner-Kahrs, Timothy D. Barfoot

Organizations: The authors are with the University of Toronto Robotics Institute, Toronto, ON, Canada.

Abstract

State estimation techniques for continuum robots (CRs) typically involve using computationally complex dynamic models, simplistic shape approximations, or are limited to quasi-static methods. These approaches can be sensitive to unmodeled disturbances acting on the robot. Inspired by a factor-graph optimization paradigm, this work introduces a continuous-time stochastic state estimation framework for continuum robots. We introduce factors based on continuous-time kinematics that are corrupted by a white noise Gaussian process (GP). By using a simple robot model paired with high-rate sensing, we show adaptability to unmodeled external forces and data dropout. The result contains an estimate of the mean and covariance for the robot's pose, velocity, and strain, each of which can be interpolated continuously in both space and time. This same interpolation scheme can be used during estimation, allowing for inclusion of measurements that are asynchronous to the estimated states. Our method's inherent sparsity leads to a linear solve complexity with respect to time and interpolation queries in constant time. We demonstrate our method on a CR with gyroscope and pose sensors, highlighting its versatility in real-world systems.

Figures & tables

Explore similar work

CardsList
  1. A Sliding-Window Filter for Online Continuous-Time Continuum Robot State Estimation

    Oct 30, 2025Spencer Teetaert, Sven Lilge, Jessica Burgner-Kahrs +1Robot State EstimationBayesian Filtering

  2. Bayesian Continuum Robot Dynamics and State Estimation

    Sep 17, 2026James M. Ferguson, Tucker Hermans, Alan KuntzFactor Graph OptimizationRobotics

  3. Discrete Geometric Modeling and Extended State Estimation of Continuum Robots

    Jun 19, 2026Maximilian Herrmann, Leander Pfeiffer, Paul KotyczkaContinuum Robot ControlRobot State Estimation