Imitation-based Path Planning and Nonlinear Model Predictive Control of a Multi-Section Continuum Robots
Tóm tắt
Flexible robots have exhibited impressive features in working in congested environments due to their compliance behavior and morphological structure. However, designing motion planning techniques and robust control strategies that actively control their deformations are challenging in many applications. Thus, this article presents the learning by Demonstration (LbD) approach for planning the spatial point-to-point motions of a multi-section continuum robot. Via teleoperation, the human demonstrations are captured by moving the flexible interface with similar kinematics of the active robot in front of the Motion Capture System (MCS). Meanwhile, a Nonlinear Model Predictive Control (NMPC) scheme is proposed based on the robot’s kinematic model to follow the reference trajectories while respecting the constraints imposed by the cable lengths and control actions. The simulation results prove the efficiency of the LbD approach in reproducing and generalizing the spatial motions of the robot’s tip and avoiding obstacles and external disturbances. On the other hand, the numerical simulations show the performance of NMPC scheme in terms of trajectory tracking and avoiding static and dynamic obstacles. Additionally, its robustness is analyzed by comparing it to the Pseudo-Inverse Jacobian Kinematic Control (PIJKC) while considering the constraints of cable lengths. Finally, the stability of NMPC is evaluated against input perturbations using the Monte Carlo simulations.
Tài liệu tham khảo
El-Hussieny, H., Jeong, S.G., Ryu, J.H.: Dynamic modeling of a class of soft growing robots using euler-lagrange formalism. Society of Instrument and Control Engineers (2019)
Ashuri, T., Armani, A., Jalilzadeh Hamidi, R., Reasnor, T., Ahmadi, S., Iqbal, K.: Biomedical soft robots: Current status and perspective. Biomed. Eng. Lett. 10(3), 369–385 (2020)
Aracri, S., Giorgio-Serchi, F., Suaria, G., Sayed, M.E., Nemitz, M.P., Mahon, S., Stokes, A.A.: Soft robots for ocean exploration and offshore operations: A perspective. Soft Robot. 8(6), 625–639 (2021)
Rao, P., Peyron, Q., Lilge, S., Burgner-Kahrs, J.: How to model tendon-driven continuum robots and benchmark modelling performance. Front. Robot. AI 7(630), 245 (2021)
Greigarn, T., Poirot, N.L., Xu, X., Çavuşoğlu, M.C.: Jacobian-based task-space motion planning for MRI-actuated continuum robots. IEEE Robot. Autom. Lett. 4(1), 145–152 (2018)
Hawks, Z., Frazelle, C., Green, K.E., Walker, I.D.: Motion planning for a continuum robotic mobile lamp: Defining and navigating the configuration space. In: IEEE International Conference on Intelligent Robots and Systems (IROS), pp 2559–2566 (2019)
Lai, J., Lu, B., Zhao, Q., Chu, H.K.: Constrained motion planning of a cable-driven soft robot with compressible curvature modeling. IEEE Robot. Autom. Lett. 7(2), 4813–4820 (2022)
Ravichandar, H., Polydoros, A.S., Chernova, S., Billard, A.: Recent advances in robot learning from demonstration. Ann. Rev. Control Rob. Autonom. Syst. 3, 297–330 (2020)
Zhu, Z., Hu, H.: Robot learning from demonstration in robotic assembly: A survey. Robotics 7(2), 17 (2018)
Lauretti, C., Cordella, F., Guglielmelli, E., Zollo, L.: Learning by demonstration for planning activities of daily living in rehabilitation and assistive robotics. IEEE Robot. Autom. Lett. 2(3), 1375–1382 (2017)
Wang, H., Chen, J., Lau, H.Y., Ren, H.: Motion planning based on learning from demonstration for multiple-segment flexible soft robots actuated by electroactive polymers. IEEE Robot. Autom. Lett. 1 (1), 391–398 (2016)
Gupta, A., Eppner, C., Levine, S., Abbeel, P.: Learning dexterous manipulation for a soft robotic hand from human demonstrations. In: IEEE International Conference on Intelligent Robots and Systems (IROS), pp 3786–3793 (2016)
Malekzadeh, M.S., Queißer, J.F., Steil, J.J.: Multi-level control architecture for bionic handling assistant robot augmented by learning from demonstration for apple-picking. Adv. Robot. 33(9), 469–485 (2019)
Kenwright, B.: A beginners guide to dual-quaternions: What they are, how they work, and how to use them for 3D character hierarchies. In: 20th International Conference on Computer Graphics Visualization and Computer Vision (2012)
Seleem, I.A., Assal, S.F., Ishii, H., El-Hussieny, H.: Guided pose planning and tracking for multi-section continuum robots considering robot dynamics. IEEE Access 7, 166,690–166,703 (2019)
Seleem, I.A., El-Hussieny, H., Assal, S.F., Ishii, H.: Development and stability analysis of an imitation learning-based pose planning approach for multi-section continuum robot. IEEE Access 8, 99,366–99,379 (2020)
Chen, C., Zhang, C., Hu, T., Ni, H., Luo, W.: Model-assisted extended state observer-based computed torque control for trajectory tracking of uncertain robotic manipulator systems. Int. J. Adv. Robot. Syst. 15(5), 1729881418801,738 (2018)
Seleem, I.A., El-Hussieny, H., Assal, S.F.M.: Motion planning for continuum robots: A learning from demonstration approach. In: 27th IEEE International Symposium on Robot and Human Interactive Communication (RO-MAN), pp 868–873 (2018)
Wang, C., Frazelle, C.G., Wagner, J.R., Walker, I.D.: Dynamic control of multisection three-dimensional continuum manipulators based on virtual discrete-jointed robot models. IEEE/ASME Trans. Mechatronics 26(2), 777–788 (2020)
Franco, E., Ayatullah, T., Sugiharto, A., Garriga-Casanovas, A., Virdyawan, V.: Nonlinear energy-based control of soft continuum pneumatic manipulators. Nonlinear Dyn. 106(1), 229–253 (2021)
Shin, C., Ferguson, P.W., Pedram, S.A., Ma, J., Dutson, E.P., Rosen, J.: Autonomous tissue manipulation via surgical robot using learning based model predictive control. In: 2019 International Conference on Robotics and Automation (ICRA), pp 3875–3881 (2019)
Chien, J.L., Clarissa, L.T.L., Liu, J., Low, J., Foong, S.: Kinematic model predictive control for a novel tethered aerial cable-driven continuum robot. In: 2021 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), pp 1348–1354 (2021)
Khadem, M., O’Neill, J., Mitros, Z., Da Cruz, L., Bergeles, C.: Autonomous steering of concentric tube robots via nonlinear model predictive control. IEEE Trans. Robot. 36(5), 1595–1602 (2020)
Chen, J., Dang, Y., Han, J.: Offset-free model predictive control of a soft manipulator using the Koopman operator. Mechatronics 86(102), 871 (2022)
Bruder, D., Fu, X., Gillespie, R.B., Remy, C.D., Vasudevan, R.: Koopman-based control of a soft continuum manipulator under variable loading conditions. IEEE Rob. Autom. Lett. 6(4), 6852–6859 (2021)
Sun, Y., Abudula, A., Yang, H., Chiang, S.S., Wan, Z., Ozel, S., Hall, R., Skorina, E., Luo, M., Onal, C.D.: Soft mobile robots: a review of soft robotic locomotion modes. Curr. Robot. Rep., 1–27 (2021)
Zaidi, S., Maselli, M., Laschi, C., Cianchetti, M.: Actuation technologies for soft robot grippers and manipulators: A review. Curr. Robot. Rep. 2(3), 355–369 (2021)
Chawla, A., Frazelle, C., Walker, I.: A comparison of constant curvature forward kinematics for multisection continuum manipulators. In: 2018 Second IEEE International Conference on Robotic Computing (IRC), pp 217–223 (2018)
Baumkircher, A., Seme, K., Munih, M., Mihelj, M.: Collaborative robot precision task in medical microbiology laboratory. Sensors 22(8), 2862 (2022)
Ude, A., Nemec, B., Petrić, T., Morimoto, J.: Orientation in cartesian space dynamic movement primitives. In: 2014 IEEE International Conference on Robotics and Automation (ICRA), pp 2997–3004 (2014)
Ginesi, M., Meli, D., Roberti, A., Sansonetto, N., Fiorini, P.: Dynamic movement primitives: Volumetric obstacle avoidance using dynamic potential functions. J. Intell. Robot. Syst. 101(4), 1–20 (2021)
Amouri, A., Cherfia, A., Merabti, H., Laib, D.L.Y.: Nonlinear model predictive control of a class of continuum robots using kinematic and dynamic models. FME Trans. 50(2), 339–350 (2022)
Andersson, J.A., Gillis, J., Horn, G., Rawlings, J.B., Diehl, M.: CasADI: a software framework for nonlinear optimization and optimal control. Math. Program. Comput. 11(1), 1–36 (2019)
Liu, M., Dassios, I., Tzounas, G., Milano, F.: Stability analysis of power systems with inclusion of realistic-modeling WAMS delays. IEEE Trans. Power Syst. 34(1), 627–636 (2018)