Search papers, labs, and topics across Lattice.
This paper introduces a unified framework for estimating external contact forces on continuum robots using Gaussian-parameterized factor graphs, addressing the challenges of ill-conditioning in multi-contact scenarios. By integrating a probabilistic Cosserat rod model with strain, tendon tension, and pose measurements, the method effectively reduces the dimensionality of unknown forces and enhances estimation accuracy. Numerical simulations reveal that this approach significantly outperforms existing methods in estimating both the location and magnitude of forces during single and multi-contact interactions.
Accurate force estimation in continuum robots can now be achieved even in complex multi-contact scenarios, outperforming traditional methods.
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.
