Path tracking of continuum robots is a fundamental and crucial problem across various applications. In this article, we address this problem by focussing on three aspects. Firstly, we propose an efficient multi-solution inverse kinematics solver for three-section constant curvature robots by bridging the theoretical reduction and the numerical correction. Secondly, we derive a linear tendon-driven actuation model, establishing the connection between the robot configuration space and the actuator space. With this model, we achieve optimal distance planning and optimal time allocation considering the constraints of actuator velocity and acceleration, generating a continuous trajectory directly in the actuator space. Finally, we present our kinematic path tracking framework, which includes offline optimal trajectory planning and online feedforward and feedback control. Experiments are conducted both in simulations and in the real world on our three-section tendon-driven continuum robot. The experiments validate the increased efficiency, higher success rates, and accessibility of multiple solutions offered by our inverse kinematics solver, as well as the optimality in distance planning and time allocation in the actuator space. Performance improvements in tracking accuracy are demonstrated through comparative experiments and the application of our framework in path tracking tasks with obstacles is presented through a case study.
AlambeigiFAghajani PedramSSpeyerJL, et al. (2020) Scade: simultaneous sensor calibration and deformation estimation of fbg-equipped unmodeled continuum manipulators. IEEE Transactions on Robotics36(1): 222–239.
2.
AlatorreDAxinteDRabaniA (2022) Continuum robot proprioception: the ionic liquid approach. IEEE Transactions on Robotics38(1): 526–535.
3.
AlmanzorEYeFShiJ, et al. (2023) Static shape control of soft continuum robots using deep visual inverse kinematic models. IEEE Transactions on Robotics.
4.
AmanovENguyenTDBurgner-KahrsJ (2021) Tendon-driven continuum robots with extensible sections—a model-based evaluation of path-following motions. The International Journal of Robotics Research40(1): 7–23.
5.
AnsariYMantiMFaloticoE, et al. (2018) Multiobjective optimization for stiffness and position control in a soft robot arm module. IEEE Robotics and Automation Letters3(1): 108–115.
6.
BajoASimaanN (2016) Hybrid motion/force control of multi-backbone continuum robots. The International Journal of Robotics Research35(4): 422–434.
7.
BajoAGoldmanREWangL, et al. (2012) Integration and preliminary evaluation of an insertable robotic effectors platform for single port access surgery. In: 2012 IEEE International Conference on Robotics and Automation. IEEE, 3381–3387.
8.
BarfootTForbesJRFurgalePT (2011) Pose estimation using linearized rotations and quaternion algebra. Acta Astronautica68(1-2): 101–112.
9.
BoyerFLebastardVCandelierF, et al. (2020) Dynamics of continuum and soft robots: a strain parameterization based approach. IEEE Transactions on Robotics37(3): 847–863.
10.
Burgner-KahrsJRuckerDCChosetH (2015) Continuum robots for medical applications: a survey. IEEE Transactions on Robotics31(6): 1261–1280.
11.
CampisanoFCalóSRemirezAA, et al. (2021) Closed-loop control of soft continuum manipulators under tip follower actuation. The International Journal of Robotics Research40(6-7): 923–938.
12.
ChirikjianGS (2011) Stochastic Models, Information Theory, and Lie Groups, Volume 2: Analytic Methods and Modern Applications. Springer Science & Business Media.
13.
ClopperCJPearsonES (1934) The use of confidence or fiducial limits illustrated in the case of the binomial. Biometrika26(4): 404–413.
14.
Della SantinaCBicchiARusD (2020a) On an improved state parametrization for soft robots with piecewise constant curvature and its use in model based control. IEEE Robotics and Automation Letters5(2): 1001–1008.
15.
Della SantinaCKatzschmannRKBicchiA, et al. (2020b) Model-based dynamic feedback control of a planar soft robot: trajectory tracking and interaction with the environment. The International Journal of Robotics Research39(4): 490–513.
16.
DengJMengBHKanjI, et al. (2019) Near-optimal smooth path planning for multisection continuum arms. In: 2019 2nd IEEE International Conference on Soft Robotics (RoboSoft). IEEE, 416–421.
17.
DijkstraEW (1959) A note on two problems in connexion with graphs. Numerische Mathematik1(1): 269–271. DOI: 10.1007/BF01386390.
18.
DongXWangMMohammadA, et al. (2022) Continuum robots collaborate for safe manipulation of high-temperature flame to enable repairs in challenging environments. IEEE/ASME Transactions on Mechatronics27(5): 4217–4220.
19.
Garriga-CasanovasARodriguez y BaenaF (2019) Kinematics of continuum robots with constant curvature bending and extension capabilities. Journal of Mechanisms and Robotics11(1): 011010.
20.
GeorgeTTFaloticoEMantiM, et al. (2017) Learning closed loop kinematic controllers for continuum manipulators in unstructured environments. Soft robotics4(3): 285–296.
21.
GodageISGuglielminoEBransonDT, et al. (2011) Novel Modal Approach for Kinematics of Multisection Continuum Arms. In: 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems. pp. 1093–1098.
22.
GodageISBransonDTGuglielminoE, et al. (2012) Path planning for multisection continuum arms. In: 2012 IEEE International Conference on Mechatronics and Automation. IEEE, 1208–1213.
23.
GonthinaPSWootenMBGodageIS, et al. (2020) Mechanics for tendon actuated Multisection continuum arms. In: 2020 IEEE International Conference on Robotics and Automation (ICRA). pp. 3896–3902.
24.
GrassmannRModesVBurgner-KahrsJ (2018) Learning the forward and inverse kinematics of a 6-dof concentric tube continuum robot in se (3). In: 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 5125–5132.
25.
HallBC (2013) Lie Groups, Lie Algebras, and Representations. Springer.
26.
HawksZFrazelleCGreenKE, et al. (2019) Motion planning for a continuum robotic mobile lamp: defining and navigating the configuration space. In: 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2559–2566.
27.
HyattPKillpackMD (2020) Real-time nonlinear model predictive control of robots using a graphics processing unit. IEEE Robotics and Automation Letters5(2): 1468–1475.
28.
KhademMO’NeillJMitrosZ, et al. (2020) Autonomous steering of concentric tube robots via nonlinear model predictive control. IEEE Transactions on Robotics36(5): 1595–1602.
29.
KoolwalABBarbagliFCarlsonC, et al. (2010) An ultrasound-based localization algorithm for catheter ablation guidance in the left atrium. The International Journal of Robotics Research29(6): 643–665.
30.
LagariasJCReedsJAWrightMH, et al. (1998) Convergence properties of the Nelder–Mead simplex method in low dimensions. SIAM Journal on optimization9(1): 112–147.
31.
LaiJHuangKLuB, et al. (2022) Verticalized-tip trajectory tracking of a 3d-printable soft continuum robot: enabling surgical blood suction automation. IEEE/ASME Transactions on Mechatronics27(3): 1545–1556.
32.
LeibrandtKBergelesCYangGZ (2017) Concentric tube robots: rapid, stable path-planning and guidance for surgical use. IEEE Robotics & Automation Magazine24(2): 42–53.
33.
LiJXiaoJ (2016) Progressive planning of continuum grasping in cluttered space. IEEE Transactions on Robotics32(3): 707–716.
34.
LiMKangRBransonDT, et al. (2017) Model-free control for continuum robots based on an adaptive kalman filter. IEEE/ASME Transactions on Mechatronics23(1): 286–297.
35.
LiYMyszkaDHMurrayA (2023) The kinematics of constant curvature continuum robots through three segments. IEEE Robotics and Automation Letters.
36.
LilgeSBarfootTDBurgner-KahrsJ (2022) Continuum robot state estimation using Gaussian process regression on se(3). The International Journal of Robotics Research41(13-14): 1099–1120.
37.
LynchKMParkFC (2017) Modern Robotics. Cambridge University Press.
38.
MahoneyAWBrunsTLSwaneyPJ, et al. (2016) On the inseparable nature of sensor selection, sensor placement, and state estimation for continuum robots or “where to put your sensors and how to use them”. In: 2016 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 4472–4478.
39.
ManochaDCannyJF (1994) Efficient inverse kinematics for general 6r manipulators. IEEE transactions on robotics and automation10(5): 648–657.
40.
MarićFGiamouMHallAW, et al. (2021) Riemannian optimization for distance-geometric inverse kinematics. IEEE Transactions on Robotics38(3): 1703–1722.
41.
MengBHGodageISKanjI (2021) Smooth path planning for continuum arms. In: 2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 7809–7814.
42.
MengBHGodageISKanjI (2022) Rrt*-based path planning for continuum arms. IEEE Robotics and Automation Letters7(3): 6830–6837.
43.
MosesMSMurphyRJKutzerMD, et al. (2015) Modeling cable and guide channel interaction in a high-strength cable-driven continuum manipulator. IEEE/ASME Transactions on Mechatronics20(6): 2876–2889.
44.
MurrayRMLiZSastrySS, et al. (1994) A Mathematical Introduction to Robotic Manipulation. CRC Press.
45.
NakamuraYHanafusaH (1986) Inverse kinematic solutions with singularity robustness for robot manipulator control. Journal of Dynamic Systems, Measurement, and Control108(3): 163–171. DOI: 10.1115/1.3143764.
46.
NeppalliSCsencsitsMAJonesBA, et al. (2009) Closed-form inverse kinematics for continuum manipulators. Advanced Robotics23(15): 2077–2091.
47.
Oliver-ButlerKChildsJADanielA, et al. (2022) Concentric push-pull robots: planar modeling and design. IEEE Transactions on Robotics38(2): 1186–1200.
48.
QiuKZhangJSunD, et al. (2023) An efficient multi-solution solver for the inverse kinematics of 3-section constant-curvature robots. In: Proceedings of Robotics: Science and Systems. Daegu, Republic of Korea. DOI: 10.15607/RSS.2023.XIX.091.
49.
RendaFBoyerFDiasJ, et al. (2018) Discrete cosserat approach for multisection soft manipulator dynamics. IEEE Transactions on Robotics34(6): 1518–1533.
50.
RendaFArmaniniCLebastardV, et al. (2020) A geometric variable-strain approach for static modeling of soft manipulators with tendon and fluidic actuation. IEEE Robotics and Automation Letters5(3): 4006–4013.
51.
RendaFArmaniniCMathewA, et al. (2022) Geometrically-exact inverse kinematic control of soft manipulators with general threadlike actuators’ routing. IEEE Robotics and Automation Letters7(3): 7311–7318.
52.
RoesthuisRJMisraS (2016) Steering of multisegment continuum manipulators using rigid-link modeling and fbg-based shape sensing. IEEE Transactions on Robotics32(2): 372–382.
53.
RoneWSBen-TzviP (2014) Continuum robot dynamics utilizing the principle of virtual power. IEEE Transactions on Robotics30(1): 275–287.
54.
RuckerDCWebsterIIIRJ (2011) Statics and dynamics of continuum robots with general tendon routing and external loading. IEEE Transactions on Robotics27(6): 1033–1044. DOI: 10.1109/TRO.2011.2160469.
55.
RusDTolleyMT (2015) Design, fabrication and control of soft robots. Nature521(7553): 467–475.
56.
SadatiSHNaghibiSEWalkerID, et al. (2017) Control space reduction and real-time accurate modeling of continuum manipulators using ritz and ritz–galerkin methods. IEEE Robotics and Automation Letters3(1): 328–335.
57.
SatheeshbabuSUppalapatiNKChowdharyG, et al. (2019) Open loop position control of soft continuum arm using deep reinforcement learning. In: 2019 International Conference on Robotics and Automation (ICRA). IEEE, 5133–5139.
58.
SicilianoBSciaviccoLVillaniL, et al. (2009) Robotics: Modelling, Planning and Control. Springer.
59.
SimaanNXuKWeiW, et al. (2009) Design and integration of a telerobotic system for minimally invasive surgery of the throat. The International Journal of Robotics Research28(9): 1134–1153.
60.
SinghILakhalOAmaraY, et al. (2017) Performances evaluation of inverse kinematic models of a compact bionic handling assistant. In: 2017 IEEE International Conference on Robotics and Biomimetics (ROBIO), 264–269.
61.
SolaJ (2017) Quaternion kinematics for the error-state kalman filter. arXiv preprint arXiv:1711.02508.
62.
SpinelliFAKatzschmannRK (2022) A unified and modular model predictive control framework for soft continuum manipulators under internal and external constraints. In: 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 9393–9400.
63.
TillJAloiVRiojasKE, et al. (2020) A dynamic model for concentric tube robots. IEEE Transactions on Robotics36(6): 1704–1718.
64.
TutcuCBaydereBATalasSK, et al. (2021) Quasi-static modeling of a novel growing soft-continuum robot. The International Journal of Robotics Research40(1): 86–98.
65.
WangJChortosA (2022) Control strategies for soft robot systems. Advanced Intelligent Systems4(5): 2100165.
66.
WebsterIIIRJJonesBA (2010) Design and kinematic modeling of constant curvature continuum robots: a review. The International Journal of Robotics Research29(13): 1661–1683.
67.
WuKWuLRenH (2015) Motion planning of continuum tubular robots based on centerlines extracted from statistical atlas. In: 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 5512–5517.
68.
YangHDAsbeckAT (2020) Design and characterization of a modular hybrid continuum robotic manipulator. IEEE/ASME Transactions on Mechatronics25(6): 2812–2823.
69.
YangCGengSWalkerI, et al. (2020) Geometric constraint-based modeling and analysis of a novel continuum robot with shape memory alloy initiated variable stiffness. The International Journal of Robotics Research39(14): 1620–1634.
70.
YipMCCamarilloDB (2014) Model-less feedback control of continuum manipulators in constrained environments. IEEE Transactions on Robotics30(4): 880–889.
Supplementary Material
Please find the following supplemental material available below.
For Open Access articles published under a Creative Commons License, all supplemental material carries the same license as the article it is associated with.
For non-Open Access articles published, all supplemental material carries a non-exclusive license, and permission requests for re-use of supplemental material or any part of supplemental material shall be sent directly to the copyright owner as specified in the copyright notice associated with the article.
