H-infinity based Extended Kalman Filter for State Estimation in Highly Non-linear Soft Robotic System

Sensor data play a significant role in the control of robotic systems. While soft robotics is promising for operation in unstructured environments, it is difficult to integrate sensors into soft robots because their inherent softness can be disturbed by the use of sensors. One way to overcome this challenge is to use an observer/filter to estimate the variables (states) that would have been measured by those sensors. Nevertheless, applying an observer/filter scheme to a soft robot introduces challenges due to the high non-linearity in its system model. In this paper, a novel $\mathcal{H}_{\infty}$ based Extended Kalman Filter (EKF) is proposed to estimate the states of a soft continuum manipulator and its performances are investigated. The $\mathcal{H}_{\infty}$-EKF are tested with model simulations of an experimentally validated soft continuum manipulator system with highly nonlinear kinematics and dynamics. The results show that $\mathcal{H}_{\infty}$-EKF achieves accurate estimations in pneumatic muscle actuator (pMA)'s elongation and manipulator's task space coordinates while estimation result for elongation rate is less satisfactory due to large model uncertainties.

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

[2]  Nabil Simaan,et al.  Hybrid motion/force control of multi-backbone continuum robots , 2016, Int. J. Robotics Res..

[3]  Apoorva D. Kapadia,et al.  A Novel Continuum Trunk Robot Based on Contractor Muscles , 2013 .

[4]  John Kenneth Salisbury,et al.  Task-Space Control of Continuum Manipulators with Coupled Tendon Drive , 2008, ISER.

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

[6]  Ian D. Walker,et al.  Field trials and testing of the OctArm continuum manipulator , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

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

[8]  Fuwen Yang,et al.  Robust H∞ filtering with error variance constraints for discrete time-varying systems with uncertainty , 2003, Autom..

[9]  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.

[10]  Dan Simon,et al.  Optimal State Estimation: Kalman, H∞, and Nonlinear Approaches , 2006 .

[11]  Hieu Minh Trinh,et al.  State and fault estimation for a class of non-infinitely observable descriptor systems using two sliding mode observers in cascade , 2019, J. Frankl. Inst..

[12]  Tao Deng,et al.  Visual servo control of cable-driven soft robotic manipulator , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Matteo Cianchetti,et al.  Shape estimation based on Kalman filtering: Towards fully soft proprioception , 2018, 2018 IEEE International Conference on Soft Robotics (RoboSoft).

[14]  Oliver Sawodny,et al.  Dynamic Control of the Bionic Handling Assistant , 2017, IEEE/ASME Transactions on Mechatronics.

[15]  Xuemin Shen,et al.  Game theory approach to discrete H∞ filter design , 1997, IEEE Trans. Signal Process..

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

[17]  Nabil Simaan,et al.  Compliant motion control for continuum robots with intrinsic actuation sensing , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[19]  Akio Ishiguro,et al.  Soft Robotics [TC Spotlight] , 2013, IEEE Robotics & Automation Magazine.

[20]  Oliver Sawodny,et al.  Dynamic Modeling of Bellows-Actuated Continuum Robots Using the Euler–Lagrange Formalism , 2015, IEEE Transactions on Robotics.

[21]  Jinwoo Jung,et al.  An evaluation of closed-loop control options for continuum manipulators , 2012, 2012 IEEE International Conference on Robotics and Automation.

[22]  M. R. Katebi,et al.  EKF versus extended h-infinity filter - application to activated sludge processes , 2006 .

[23]  John J. Craig,et al.  Introduction to Robotics Mechanics and Control , 1986 .

[24]  Hieu Minh Trinh,et al.  A common functional observer scheme for three systems with unknown inputs , 2016, J. Frankl. Inst..

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

[26]  Christian Duriez,et al.  Control Design for Soft Robots Based on Reduced-Order Model , 2019, IEEE Robotics and Automation Letters.

[27]  John J. Craig Zhu,et al.  Introduction to robotics mechanics and control , 1991 .

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

[29]  Kai Xu,et al.  Actuation compensation for flexible surgical snake-like robots with redundant remote actuation , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[30]  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.

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

[32]  Matteo Cianchetti,et al.  Dynamic Model of a Multibending Soft Robot Arm Driven by Cables , 2014, IEEE Transactions on Robotics.

[33]  M Giorelli,et al.  A 3D steady-state model of a tendon-driven continuum soft manipulator inspired by the octopus arm , 2012, Bioinspiration & biomimetics.