Accelerated Quasi-Static FEM for Real-Time Modeling of Continuum Robots with Multiple Contacts and Large Deformation
Hao Chen, Jian Chen, Xinran Liu, Zihui Zhang, Yuanrui Huang, Zhongkai Zhang, Hongbin Liu
TL;DR
This work addresses the real-time simulation challenge of continuum robots undergoing large deformations with multiple environmental contacts. It introduces Acc-FEM, an accelerated quasi-static finite element approach that formulates contact-rich deformation as a mixed linear complementarity problem, linearizes via the tangent stiffness from the previous step, and solves a resulting convex quadratic program with OSQP. A GPU-accelerated pipeline handles tangent-stiffness updates and collision detection, while a postprocessing step stabilizes step sizes to prevent penetration. The method is validated against a SOFA-based baseline and in real-robot experiments, demonstrating significant speed advantages and accurate deformation/force estimation in multi-contact scenarios. The approach has potential to enable real-time planning and control for flexible surgical robots in narrow cavities and other complex environments.
Abstract
Continuum robots offer high flexibility and multiple degrees of freedom, making them ideal for navigating narrow lumens. However, accurately modeling their behavior under large deformations and frequent environmental contacts remains challenging. Current methods for solving the deformation of these robots, such as the Model Order Reduction and Gauss-Seidel (GS) methods, suffer from significant drawbacks. They experience reduced computational speed as the number of contact points increases and struggle to balance speed with model accuracy. To overcome these limitations, we introduce a novel finite element method (FEM) named Acc-FEM. Acc-FEM employs a large deformation quasi-static finite element model and integrates an accelerated solver scheme to handle multi-contact simulations efficiently. Additionally, it utilizes parallel computing with Graphics Processing Units (GPU) for real-time updates of the finite element models and collision detection. Extensive numerical experiments demonstrate that Acc-FEM significantly improves computational efficiency in modeling continuum robots with multiple contacts while achieving satisfactory accuracy, addressing the deficiencies of existing methods.
