Hierarchical Decomposed-Objective Model Predictive Control for Autonomous Casualty Extraction

In recent years, several robots have been developed and deployed to perform casualty extraction tasks. However, the majority of these robots are overly complex, and require teleoperation via either a skilled operator or a specialised device, and often the operator must be present at the scene to navigate safely around the casualty. Instead, improving the autonomy of such robots can reduce the reliance on expert operators and potentially unstable communication systems, while still extracting the casualty in a safe manner. There are several stages in the casualty extraction procedure, from navigating to the location of the emergency, safely approaching and loading the casualty, to finally navigating back to the medical assistance location. In this paper, we propose a Hierarchical Decomposed-Objective based Model Predictive Control (HiDO-MPC) method for safely approaching and manoeuvring around the casualty. We implement this controller on ResQbot — a proof-of-concept mobile rescue robot we previously developed — capable of safely rescuing an injured person lying on the ground, i.e. performing the casualty extraction procedure. HiDO-MPC achieves the desired casualty extraction behaviour by decomposing the main objective into multiple sub-objectives with a hierarchical structure. At every time step, the controller evaluates this hierarchical decomposed objective and generates the optimal control decision. We have conducted a number of experiments both in simulation and using the real robot to evaluate the proposed method’s performance, and compare it with baseline approaches. The results demonstrate that the proposed control strategy gives significantly better results than baseline approaches in terms of accuracy, robustness, and execution time, when applied to casualty extraction scenarios.

[1]  Roland Siegwart,et al.  Fast nonlinear Model Predictive Control for unified trajectory optimization and tracking , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Youngwoo Lee,et al.  Development and control of a military rescue robot for casualty extraction task , 2019, J. Field Robotics.

[3]  Petar Kormushev,et al.  ResQbot: A Mobile Rescue Robot for Casualty Extraction , 2018, HRI.

[4]  Koichi Osuka,et al.  Evaluation of rescue support stretcher system , 2012, 2012 IEEE RO-MAN: The 21st IEEE International Symposium on Robot and Human Interactive Communication.

[5]  Petar Kormushev,et al.  Casualty Detection from 3D Point Cloud Data for Autonomous Ground Mobile Rescue Robots , 2018, 2018 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[6]  Can Isik,et al.  Pilot level of a hierarchical controller for an unmanned mobile robot , 1988, IEEE J. Robotics Autom..

[7]  R. Fierro,et al.  Hierarchical Optimization Strategies for Deployment of Mobile Robots , 2006 .

[8]  Stefan Kohlbrecher,et al.  A flexible and scalable SLAM system with full 3D motion estimation , 2011, 2011 IEEE International Symposium on Safety, Security, and Rescue Robotics.

[9]  Roland Siegwart,et al.  Robust collision avoidance for multiple micro aerial vehicles using nonlinear model predictive control , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Renquan Lu,et al.  Trajectory-Tracking Control of Mobile Robot Systems Incorporating Neural-Dynamic Optimized Model Predictive Approach , 2016, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[11]  Raghvendra V. Cowlagi,et al.  Hierarchical Motion Planning With Dynamical Feasibility Guarantees for Mobile Robotic Vehicles , 2012, IEEE Transactions on Robotics.

[12]  Giovanni Indiveri Kinematic time-invariant control of a 2D nonholonomic vehicle , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[14]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[15]  Dongbing Gu,et al.  A stabilizing receding horizon regulator for nonholonomic mobile robots , 2005, IEEE Transactions on Robotics.

[16]  Pinhas Ben-Tzvi,et al.  A Robotic Head Stabilization Device for Medical Transport , 2019, Robotics.

[17]  Koichi Osuka,et al.  Development of rescue support stretcher system , 2010, 2010 IEEE Safety Security and Rescue Robotics.

[18]  Arnulfo Alanis Garza,et al.  Reactive and tracking control of a mobile robot in a distributed environment using fuzzy logic , 2010, International Conference on Fuzzy Systems.

[19]  Petar Kormushev,et al.  ResQbot: A Mobile Rescue Robot with Immersive Teleperception for Casualty Extraction , 2018, TAROS.

[20]  Kevin L. Moore,et al.  Hierarchical task decomposition approach to path planning and control for an omni-directional autonomous mobile robot , 1999, Proceedings of the 1999 IEEE International Symposium on Intelligent Control Intelligent Systems and Semiotics (Cat. No.99CH37014).

[21]  Sina Sharif Mansouri,et al.  Nonlinear MPC for Collision Avoidance and Control of UAVs With Dynamic Obstacles , 2020, IEEE Robotics and Automation Letters.

[22]  Dongkyoung Chwa,et al.  Sliding-mode tracking control of nonholonomic wheeled mobile robots in polar coordinates , 2004, IEEE Transactions on Control Systems Technology.

[23]  Mohamed W. Mehrez Said,et al.  Optimization Based Solutions for Control and State Estimation in Non-holonomic Mobile Robots: Stability, Distributed Control, and Relative Localization , 2017, ArXiv.

[24]  J. A. Rossiter,et al.  Model-Based Predictive Control : A Practical Approach , 2017 .

[25]  Noriaki Hirose,et al.  MPC policy learning using DNN for human following control without collision , 2018, Adv. Robotics.

[26]  Henk Nijmeijer,et al.  Tracking Control of Mobile Robots: A Case Study in Backstepping , 1997, Autom..

[27]  Pantelis Sopasakis,et al.  Aerial navigation in obstructed environments with embedded nonlinear model predictive control , 2018, 2019 18th European Control Conference (ECC).

[28]  Fumitoshi Matsuno,et al.  Model Predictive Formation Control Using Branch-and-Bound Compatible With Collision Avoidance Problems , 2013, IEEE Transactions on Robotics.

[29]  Koichi Osuka,et al.  Development of rescue support stretcher system with stair-climbing , 2011, 2011 IEEE International Symposium on Safety, Security, and Rescue Robotics.

[30]  Marilena Vendittelli,et al.  WMR control via dynamic feedback linearization: design, implementation, and experimental validation , 2002, IEEE Trans. Control. Syst. Technol..

[31]  Stefan Preitl,et al.  Iterative Feedback and Learning Control. Servo systems applications , 2007 .

[32]  Jasper Snoek,et al.  Practical Bayesian Optimization of Machine Learning Algorithms , 2012, NIPS.

[33]  Timothy J. Broderick,et al.  Military Robotic Combat Casualty Extraction and Care , 2011 .

[34]  Z. Zenn Bien,et al.  Hierarchical Longitudinal Controller for Rear-End Collision Avoidance , 2007, IEEE Transactions on Industrial Electronics.

[35]  Manh Duong Phung,et al.  Behavior-based Navigation of Mobile Robot in Unknown Environments Using Fuzzy Logic and Multi-Objective Optimization , 2017, ArXiv.

[36]  Vryan Gil Palma,et al.  Direct optimal control and model predictive control , 2017 .

[37]  Rolf Findeisen,et al.  Hierarchical Model Predictive Control for Autonomous Vehicle Area Coverage , 2019 .

[38]  Oscar Castillo,et al.  Hierarchical Genetic Optimization of the Fuzzy Integrator for Navigation of a Mobile Robot , 2013, Soft Computing Applications in Optimization, Control, and Recognition.

[39]  Alberto Bemporad,et al.  Multiobjective model predictive control , 2009, Autom..

[40]  Olivier Verlinden,et al.  Comparative Application of Model Predictive Control Strategies to a Wheeled Mobile Robot , 2017, J. Intell. Robotic Syst..

[41]  Shuzhi Sam Ge,et al.  Adaptive Tracking Control of Surface Vessel Using Optimized Backstepping Technique , 2019, IEEE Transactions on Cybernetics.

[42]  Yasuhisa Hasegawa,et al.  Learning method for hierarchical behavior controller , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[43]  Radu-Emil Precup,et al.  Grey Wolf Optimizer-Based Approach to the Tuning of Pi-Fuzzy Controllers with a Reduced Process Parametric Sensitivity , 2016 .

[44]  Ting Qu,et al.  MPC for Path Following Problems of Wheeled Mobile Robots , 2018 .

[45]  Alejandro Agostini,et al.  Manipulation Planning Using Object-Centered Predicates and Hierarchical Decomposition of Contextual Actions , 2020, IEEE Robotics and Automation Letters.

[46]  André Scolari Conceição,et al.  Nonlinear Model Predictive Visual Path Following Control to Autonomous Mobile Robots , 2018, J. Intell. Robotic Syst..

[47]  Mansour Alsulaiman,et al.  A Hierarchical Fuzzy Control Design for Indoor Mobile Robot , 2014 .

[48]  David G. Dorrell,et al.  Sequential Model Predictive Control of Three-Phase Direct Matrix Converter , 2019, Energies.

[49]  Nabil Derbel,et al.  Optimal trajectory of a mobile robot using hierarchical fuzzy logic controller , 2016, Int. J. Comput. Appl. Technol..

[50]  Haitham Abu-Rub,et al.  Computationally-efficient Hierarchical Optimal Controller for Grid-tied Cascaded Multilevel Inverters , 2019, 2019 IEEE Energy Conversion Congress and Exposition (ECCE).

[51]  P. Falcone,et al.  A hierarchical Model Predictive Control framework for autonomous ground vehicles , 2008, 2008 American Control Conference.

[52]  Riccardo Scattolini,et al.  A receding horizon approach to the multiobjective control problem , 2007, 2007 46th IEEE Conference on Decision and Control.

[53]  Liang Huang,et al.  Multiobjective Optimization for Controller Design , 2008 .

[54]  Alonzo Kelly,et al.  Receding Horizon Model-Predictive Control for Mobile Robot Navigation of Intricate Paths , 2009, FSR.

[55]  P. Siano,et al.  Nonlinear Optimal Control of Oxygen and Carbon Dioxide Levels in Blood , 2017 .

[56]  Petar Kormushev,et al.  Sim-to-Real Learning for Casualty Detection from Ground Projected Point Cloud Data , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[57]  Koichi Osuka,et al.  Motion control of multi-linked stretcher robot DUCKS , 2010, Proceedings of SICE Annual Conference 2010.

[58]  J R Engsberg,et al.  Spinal cord and brain injury protection: testing concept for a protective device , 2009, Spinal Cord.