Multi-Contact Force Estimation for Continuum Robots via Gaussian-Parameterized Factor Graphs
Aditya Prakash, Panagiotis Tsiotras · 2026
Read Multi-Contact Force Estimation for Continuum Robots via Gaussian-Parameterized Factor Graphs by Aditya Prakash, Panagiotis Tsiotras (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2606-29165.txt.
Introduction
Prakash and Tsiotras present a method for estimating contact forces anywhere along a continuum robot, a flexible robot that bends continuously rather than at joints. Such robots suit unstructured environments, but safe operation requires knowing external forces at unknown points along the body. Several contacts at once make an ill-conditioned problem, where small measurement errors can produce wild force guesses.
Their framework estimates shape and forces together on a factor graph linking measurements and unknowns. A Gaussian mixture form describes the forces compactly, cutting dimensionality and easing the ill-conditioning. A discretised Cosserat rod model supplies the robot's mechanics. The system fuses strain, tendon tension and pose readings, tracking modelling and sensor uncertainty. In simulations it beat existing methods on force location and magnitude, for single and multiple contacts.
Catalog record
| CREATOR | Aditya Prakash, Panagiotis Tsiotras |
|---|---|
| YEAR | 2026 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 47 KB |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2606.29165
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
Multi-Contact Force Estimation for Continuum Robots via Gaussian-Parameterized Factor Graphs Aditya Prakash, Panagiotis Tsiotras Abstract Continuum robots offer key advantages in navigating unstructured environments, but their safe operation requires accurate estimation of the external contact forces acting anywhere along the robot body. Estimating these forces at unknown locations is an ill-conditioned problem, particularly for multiple contacts. We propose a unified shape and force estimation framework formulated on a factor graph. By incorporating a Gaussian mixture force parameterization into a discretized probabilistic Cosserat rod model, we reduce the dimensionality of the unknown external forces and mitigate the ill-conditioning of node-wise force estimation. The framework fuses strain, tendon tension, and pose measurements to simultaneously estimate the robot’s shape and external forces while accounting for modeling and sensor uncertainties. Numerical simulations demonstrate that the proposed method outperforms existing methods in terms of force location and magnitude estimation for both single and multi-contact scenarios. We further present a progressive variant that introduces basis functions on demand to estimate contact forces sequentially during a simulated confined-navigation task. I Introduction Continuum robots [ 21 ] offer an inherent mechanical advantage over rigid robots in unstructured and confined environments due to their flexibility and compliance [ 22 ] . Continuous deformation makes soft robots well-suited for operations in complex and cluttered environments. Furthermore, their structural compliance enables continuum robots to interact safely with the environment without damaging the robot or its surroundings. Together, these characteristics enable continuum and soft robots to operate effectively in unstructured and confined environments that are completely unknown or highly uncertain [ 26 , 1 ] , making them suited for several applications, including minimally invasive surgery [ 6 ] , post-disaster search and rescue [ 27 ] , and the inspection of complex machinery [ 25 ] . Safe and effective navigation in unknown or uncertain environments requires accurate force sensing along the continuum robot [ 16 ] . For example, force estimates can be used to regulate the contact force between the catheter and tissue during cardiac ablation procedures. It can also be used during navigation through constrained paths, such as pipes, to enable adaptive stiffness and shape adjustments, ensuring safe and smooth movement. In the absence of an explicit environmental map and visual sensors, the robot must localize and estimate contact forces utilizing only on-board measurements. Recent research has addressed force estimation for continuum robots, primarily focusing on isolated tip-force estimation [ 11 , 9 , 5 , 23 ] . Estimating forces at the tip is effective for targeted tasks like ablation or tactile exploration, where the robot body remains in free space while the tip interacts with the environment. However, tip-contact assumptions break down during operation in unstructured and unknown environments, where collisions can occur anywhere along the robot’s length [ 16 ] . To address collisions along continuum robots, the authors in [ 3 ] proposed a kinematics-based method for contact detection and localization using screw motion deviation. Their method primarily addressed single-contact estimation and was extended to multiple-contact estimation in [ 17 ] using a contact particle filter and a kinetostatic model. However, reliable estimation was confined to the distal segments, and the particle filter scaled poorly as the number of contacts grows. Alternatively, in [ 2 ] the authors used a statics model to jointly localize and estimate contact forces. They showed that the force estimation problem is inherently ill-posed, as multiple force distributions can yield the same physical deformation, and certain external forces have reduced observability due to the lack of resulting deformation. To resolve this, the authors of [ 2 ] used Gaussian functions to parameterize the external load and showed that they can successfully approximate both point loads and uniformly distributed loads by varying the standard deviation of the parameterization. However, their approach relies on known pose measurements and deterministic models, making it vulnerable to sensor noise. In parallel, there has been a trend toward using proprioceptive measurements for force estimation, with a particular focus on strain and tendon tension. In [ 15 ] , contact is localized along a catheter using the shape measured by an embedded multi-core FBG fiber. Similarly, [ 24 ] combines embedded stretch sensors with actuation variables in a kinetostatic strain model to recover both shape and 3D force. In [ 14 ] , tension profiles alongside FBG-instrumented actuation fibers are used to recover the location and magnitude of body contacts. Furthermore, in [ 10 ] , force and shape are estimated from tendon length and tendon tension alone. Together, these studies demonstrate that utilizing backbone strain and tendon tension provides an experimentally proven, sensor-efficient approach to force estimation. Building on these multimodal sensing strategies, the authors of [ 13 ] introduced a unified shape and force estimation framework that utilizes Gaussian process regression. While effective, modeling distributed forces via Brownian motion is poorly suited for the localized, discrete point forces characteristic of environmental obstacle collisions. Reference [ 12 ] provided the probabilistic foundation needed for modeling point forces by introducing a discretized stochastic Cosserat model that accounts for uncertainty in sensing, tendons, and mechanics. The model in [ 12 ] admits a wrench at every node; however, determining point forces at unknown locations would require estimating forces at every node, rendering the estimation problem severely ill-conditioned. To overcome the previous limitations, we incorporate a Gaussian mixture parameterization of the distributed external forces in the discrete Cosserat model and formulation of a unified shape-and-force estimation problem. We exploit the Lie group algebra structure of the problem formulation to derive the integration of the discretized model for the parameterized forces. We then formulate the state estimation problem using a factor graph architecture [ 7 ] , which allows us to probabilistically fuse the multi-sensory measurements with the robot’s static model. By varying the standard deviation of the Gaussian functions, the parameterization can model both point and distributed forces. By controlling the number of basis functions, we reduce the dimensionality of the unknown external forces. The rest of the paper is organized as follows: Section II discusses the Cosserat rod model and its discretized version with force parameterization. Section III formulates the factor graph for shape and force estimation. Section IV presents numerical simulation results demonstrating the efficiency of the proposed method, followed by Section V, which demonstrates the framework’s practical application for progressively estimating sequential contacts within a confined environment. Finally, we conclude the paper in Section VI. II Cosserat Rod Model The pose of a continuum rod-shaped robot along its arc length, s\in[0,L] , is denoted by \mathbf{T}(\cdot):s\mapsto\mathbf{T}(s)\in\mathrm{SE}(3) . It is typically represented by the matrix \mathbf{T}(s)=\begin{bmatrix}\mathbf{R}(s)&\mathbf{r}(s)\\ \mathbf{0}&1\end{bmatrix}, (1) where \mathbf{r}(s)\in\mathbb{R}^{3} is the position vector of the body frame origin at s , and \mathbf{R}(s)\in\mathrm{SO}(3) is the rotation matrix representing the orientation of the body frame at s with respect to the world frame. Figure 1 shows the schematic of a continuum robot. The kinematics equation is given by \frac{\mathrm{d}}{\mathrm{d}s}\mathbf{T}(s)=\mathbf{T}(s)\xi(s)^{\wedge}, (2) where \boldsymbol{\xi}(\cdot):s\mapsto\boldsymbol{\xi}(s)=\begin{bmatrix}\boldsymbol{\Psi}^{\mbox{\tiny\sf T}}&\boldsymbol{\Gamma}^{\mbox{\tiny\sf T}}\end{bmatrix}^{\mbox{\tiny\sf T}}\in\mathbb{R}^{6} defines the strain of the continuum robot and \xi(s)^{\wedge}=\begin{bmatrix}\boldsymbol{\Psi}^{\times}&\boldsymbol{\Gamma}\\ \mathbf{0}&0\end{bmatrix}\in\mathfrak{se}(3). (3) In the above equations, \boldsymbol{\Psi}(s)\in\mathbb{R}^{3} represents the angular strain, \boldsymbol{\Gamma}(s)\in\mathbb{R}^{3} represents the linear strain, and (\cdot)^{\times} denotes the skew-symmetric matrix of the corresponding vector in \mathbb{R}^{3} . The constitutive equation