Model-based dynamic feedback control of a planar soft robot: trajectory tracking and interaction with the environment

Leveraging the elastic bodies of soft robots promises to enable the execution of dynamic motions as well as compliant and safe interaction with an unstructured environment. However, the exploitation of these abilities is constrained by the lack of appropriate control strategies. This work tackles for the first time the development of closed-loop dynamic controllers for a continuous soft robot. We present two architectures designed for dynamic trajectory tracking and surface following, respectively. Both controllers are designed to preserve the natural softness of the robot and adapt to interactions with an unstructured environment. The validity of the controllers is proven analytically within the hypotheses of the model. The controllers are evaluated through an extensive series of simulations, and through experiments on a physical soft robot capable of planar motions.

[1]  Cosimo Della Santina,et al.  Dynamic Control of Soft Robots with Internal Constraints in the Presence of Obstacles , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Ian D. Walker,et al.  Empirical investigation of closed-loop control of extensible continuum manipulators , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Leopoldo Greco,et al.  B-Spline interpolation of Kirchhoff-Love space rods , 2013 .

[4]  Jean-Jacques E. Slotine,et al.  On Contraction Analysis for Non-linear Systems , 1998, Autom..

[5]  P. Olver Nonlinear Systems , 2013 .

[6]  Darwin G. Caldwell,et al.  Model Validation of an Octopus Inspired Continuum Robotic Arm for Use in Underwater Environments , 2013 .

[7]  Matteo Cianchetti,et al.  Soft robotics: Technologies and systems pushing the boundaries of robot abilities , 2016, Science Robotics.

[8]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[9]  Christian Duriez,et al.  Dynamic Control of Soft Robots , 2017 .

[10]  Paolo Dario,et al.  Soft Robot Arm Inspired by the Octopus , 2012, Adv. Robotics.

[11]  Roy Featherstone,et al.  Rigid Body Dynamics Algorithms , 2007 .

[12]  Cagdas D. Onal,et al.  Motion control of a soft-actuated modular manipulator , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Weiping Li,et al.  Applied Nonlinear Control , 1991 .

[14]  RusDaniela,et al.  Design, kinematics, and control of a soft spatial fluidic elastomer manipulator , 2016 .

[15]  Ian D. Walker,et al.  Kinematics and the Implementation of an Elephant's Trunk Manipulator and Other Continuum Style Robots , 2003, J. Field Robotics.

[16]  A. D. Lewis,et al.  Geometric control of mechanical systems : modeling, analysis, and design for simple mechanical control systems , 2005 .

[17]  Oliver M. O’Reilly,et al.  On constitutive relations for a rod-based model of a pneu-net bending actuator , 2016 .

[18]  RusDaniela,et al.  Dynamics and trajectory optimization for a soft spatial fluidic elastomer manipulator , 2016 .

[19]  WirzRaul,et al.  Accurate and Efficient Dynamics for Variable-Length Continuum Arms: A Center of Gravity Approach , 2015 .

[20]  Francisco Chinesta,et al.  Reduced-order modeling of soft robots , 2018, PloS one.

[21]  Lakmal Seneviratne,et al.  Adaptive Control Of Robot Manipulators , 1992, Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Alexander Dietrich,et al.  Position control of an underactuated continuum mechanism using a reduced nonlinear model , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[23]  R. Wood,et al.  Meshworm: A Peristaltic Soft Robot With Antagonistic Nickel Titanium Coil Actuators , 2013, IEEE/ASME Transactions on Mechatronics.

[24]  Michael R. Zinn,et al.  A combined modal-joint space control approach for continuum manipulators , 2014, Adv. Robotics.

[25]  Nivedhitha Giri A New Approach to Dynamic Modeling of Continuum Robots , 2011 .

[26]  João Pedro Hespanha,et al.  A Survey of Recent Results in Networked Control Systems , 2007, Proceedings of the IEEE.

[27]  Christian Ott,et al.  Cartesian Impedance Control of Redundant and Flexible-Joint Robots , 2008, Springer Tracts in Advanced Robotics.

[28]  D. Caleb Rucker,et al.  Efficient computation of multiple coupled Cosserat rod models for real-time simulation and control of parallel continuum manipulators , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[29]  Biao Huang,et al.  System Identification , 2000, Control Theory for Physicists.

[30]  Ian D. Walker,et al.  Task-space control of extensible continuum manipulators , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Olivier Bruls,et al.  Trajectory planning of soft link robots with improved intrinsic safety , 2017 .

[32]  Ian D. Walker,et al.  Three module lumped element model of a continuum arm section , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Daniela Rus,et al.  Dynamics and trajectory optimization for a soft spatial fluidic elastomer manipulator , 2016, Int. J. Robotics Res..

[34]  Stephen A. Morin,et al.  Soft Robotics: Review of Fluid‐Driven Intrinsically Soft Devices; Manufacturing, Sensing, Control, and Applications in Human‐Robot Interaction   , 2017 .

[35]  M. Rubin Cosserat Theories: Shells, Rods and Points , 2000 .

[36]  Darwin G. Caldwell,et al.  Dynamic modeling and control of an octopus inspired multiple continuum arm robot , 2012, Comput. Math. Appl..

[37]  Daniel Leidner,et al.  Object-centered hybrid reasoning for whole-body mobile manipulation , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[38]  Alessandro De Luca,et al.  Robot Collisions: A Survey on Detection, Isolation, and Identification , 2017, IEEE Transactions on Robotics.

[39]  Mattia Gazzola,et al.  Dynamics of soft filaments that can stretch, shear, bend and twist , 2016 .

[40]  Cagdas D. Onal,et al.  Feedforward augmented sliding mode motion control of antagonistic soft pneumatic actuators , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[41]  Jérémie Dequidt,et al.  Kinematic modeling and observer based control of soft robot using real-time Finite Element Method , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[42]  Lakmal D. Seneviratne,et al.  Discrete Cosserat Approach for Multi-Section Soft Robots Dynamics , 2017, ArXiv.

[43]  Scott Kuindersma,et al.  Optimization-based locomotion planning, estimation, and control design for the atlas humanoid robot , 2015, Autonomous Robots.

[44]  D Bigoni,et al.  Asymptotic self-restabilization of a continuous elastic structure. , 2016, Physical review. E.

[45]  Sigurd Skogestad,et al.  Simple analytic rules for model reduction and PID controller tuning , 2003 .

[46]  Daniela Rus,et al.  Design, kinematics, and control of a soft spatial fluidic elastomer manipulator , 2016, Int. J. Robotics Res..

[47]  TedrakeRuss,et al.  Optimization-based locomotion planning, estimation, and control design for the atlas humanoid robot , 2016 .

[48]  Robert J. Wood,et al.  Modeling of Soft Fiber-Reinforced Bending Actuators , 2015, IEEE Transactions on Robotics.

[49]  Ulrich Eggers,et al.  Introduction To Infinite Dimensional Linear Systems Theory , 2016 .

[50]  D. Rus,et al.  Design, fabrication and control of soft robots , 2015, Nature.

[51]  Matteo Bianchi,et al.  Controlling Soft Robots: Balancing Feedback and Feedforward Elements , 2017, IEEE Robotics & Automation Magazine.

[52]  Oliver Sawodny,et al.  A Variable Curvature Continuum Kinematics for Kinematic Control of the Bionic Handling Assistant , 2014, IEEE Transactions on Robotics.

[53]  Emanuele Guglielmino,et al.  Modal kinematics for multisection continuum arms , 2015, Bioinspiration & biomimetics.

[54]  Alessandro De Luca,et al.  A general algorithm for dynamic feedback linearization of robots with elastic joints , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[55]  Emanuel Azizi,et al.  Flexible mechanisms: the diverse roles of biological springs in vertebrate movement , 2011, Journal of Experimental Biology.

[56]  Maxwell Herman,et al.  The Soft Robotics Toolkit: Strategies for Overcoming Obstacles to the Wide Dissemination of Soft-Robotic Hardware , 2017, IEEE Robotics & Automation Magazine.

[57]  Andrea Giusti,et al.  Robust Control of Continuum Robots using Interval Arithmetic , 2017 .

[58]  Jon Rigelsford,et al.  Modelling and Control of Robot Manipulators , 2000 .

[59]  Darwin G. Caldwell,et al.  Dynamics for variable length multisection continuum arms , 2016, Int. J. Robotics Res..

[60]  Antonio Bicchi,et al.  Dynamic Motion Control of Multi-Segment Soft Robots Using Piecewise Constant Curvature Matched with an Augmented Rigid Body Model , 2019, 2019 2nd IEEE International Conference on Soft Robotics (RoboSoft).

[61]  S. M. Hadi Sadati,et al.  Control Space Reduction and Real-Time Accurate Modeling of Continuum Manipulators Using Ritz and Ritz–Galerkin Methods , 2018, IEEE Robotics and Automation Letters.

[62]  Pinhas Ben-Tzvi,et al.  Continuum Robot Dynamics Utilizing the Principle of Virtual Power , 2014, IEEE Transactions on Robotics.

[63]  Xinwu Liang,et al.  Visual Servoing of Soft Robot Manipulator in Constrained Environments With an Adaptive Controller , 2017, IEEE/ASME Transactions on Mechatronics.

[64]  Jun Nakanishi,et al.  Operational Space Control: A Theoretical and Empirical Comparison , 2008, Int. J. Robotics Res..

[65]  Ian D. Walker,et al.  Kinematics for multisection continuum robots , 2006, IEEE Transactions on Robotics.

[66]  Matteo Bianchi,et al.  Decentralized Trajectory Tracking Control for Soft Robots Interacting With the Environment , 2018, IEEE Transactions on Robotics.

[67]  Rafael Kelly,et al.  A tuning procedure for stable PID control of robot manipulators , 1995, Robotica.

[68]  Ian D. Walker,et al.  Large deflection dynamics and control for planar continuum robots , 2001 .

[69]  Eitan Grinspun,et al.  Discrete elastic rods , 2008, ACM Trans. Graph..

[70]  Ian D. Walker,et al.  A model-based sliding mode controller for extensible continuum robots , 2010 .

[71]  Kaare Brandt Petersen,et al.  The Matrix Cookbook , 2006 .

[72]  K. Gu Stability and Stabilization of Infinite Dimensional Systems with Applications , 1999 .

[73]  Nabil Simaan,et al.  Configuration and joint feedback for enhanced performance of multi-segment continuum robots , 2011, 2011 IEEE International Conference on Robotics and Automation.

[74]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[75]  Daniela Rus,et al.  Exploration of underwater life with an acoustically controlled soft robotic fish , 2018, Science Robotics.

[76]  Peter I. Corke,et al.  A robotics toolbox for MATLAB , 1996, IEEE Robotics Autom. Mag..

[77]  Ian D. Walker,et al.  Limiting-case Analysis of Continuum Trunk Kinematics , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[78]  Daniela Rus,et al.  Autonomous Object Manipulation Using a Soft Planar Grasping Manipulator , 2015, Soft robotics.

[79]  Russell L. Andersson,et al.  Aggressive trajectory generator for a robot ping-pong player , 1988, IEEE Control Systems Magazine.

[80]  Robert J. Webster,et al.  Design and Kinematic Modeling of Constant Curvature Continuum Robots: A Review , 2010, Int. J. Robotics Res..

[81]  Hans Zwart,et al.  An Introduction to Infinite-Dimensional Linear Systems Theory , 1995, Texts in Applied Mathematics.

[82]  Mariangela Manti,et al.  Stable Open Loop Control of Soft Robotic Manipulators , 2018, IEEE Robotics and Automation Letters.

[83]  Cecilia Laschi,et al.  Control Strategies for Soft Robotic Manipulators: A Survey. , 2018, Soft robotics.

[84]  Daniela Rus,et al.  Whole arm planning for a soft and highly compliant 2D robotic manipulator , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[85]  Cosimo Della Santina,et al.  Dynamic control of soft robots interacting with the environment , 2018, 2018 IEEE International Conference on Soft Robotics (RoboSoft).

[86]  Frank Chongwoo Park,et al.  Comparative analysis of energy-based criteria for dynamics-based robot motion optimization , 2017, 2017 IEEE Conference on Control Technology and Applications (CCTA).

[87]  Bruno Siciliano,et al.  A nonlinear finite element formalism for modelling flexible and soft manipulators , 2016, 2016 IEEE International Conference on Simulation, Modeling, and Programming for Autonomous Robots (SIMPAR).

[88]  D. Bigoni,et al.  From the elastica compass to the elastica catapult: an essay on the mechanics of soft robot arm , 2017, Proceedings of the Royal Society A: Mathematical, Physical and Engineering Sciences.

[89]  Mehmet Remzi Dogar,et al.  Robust proprioceptive grasping with a soft robot hand , 2018, Auton. Robots.

[90]  Oliver Sawodny,et al.  Model-based feedforward position control of constant curvature continuum robots using feedback linearization , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[91]  Carlos Balaguer,et al.  Robust Motion Control of a Soft Robotic System Using Fractional Order Control , 2017, RAAD.

[92]  Oussama Khatib,et al.  Manipulator control at kinematic singularities: a dynamically consistent strategy , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

[93]  Fumiya Iida,et al.  The challenges ahead for bio-inspired 'soft' robotics , 2012, CACM.