Control of a quadrupedal manipulator using hierarchical inverse dynamics

Currently the prevalence of general purpose mobile robots with manipulation capabilities is still low, despite various applications of such systems such as: disaster response, payload delivery, and assistive/service tasks. A suitable design for such a robot would be that of a torque-controllable quadrupedal manipulator. Its capability for legged locomotion enables high mobility, specifically on rough terrain, while its quadrupedal morphology provides a relatively large and stable base of support compared to bipedal robots. Torque-controlled joints allow for safer and more controllable interaction with the environment. For such a system a challenge lies in the design of a controller that actually achieves the promising capabilities for locomotion and manipulation that the mechanical system offers. One of the currently most promising control frameworks for this purpose is that of hierarchical inverse dynamics. This real-time whole-body control framework allows for dynamic whole-body motions and compliant interaction with the environment while enforcing a strict priority between the desired control tasks. Although promising results have previously been attained with such controllers, it has not yet been applied for the control of a quadrupedal manipulator. The focus of this thesis is on the implementation of a hierarchical inverse dynamics controller for the control of a simulated quadrupedal manipulator, with a particular focus on the design of prioritized sets of control tasks which generate forms of stationary whole-body manipulation. First a basic set of prioritized control tasks is presented, which is shown to satisfy the robot's most crucial control requirements. Subsequently three extended sets of control tasks are presented, which result in additional desirable emergent behavior of the robot. The first one of these depends on the inclusion of kinematic joint limit tasks to prevent kinematic singularities and self-collision, and to trigger whole-body reaching motion. Secondly a set of tasks is presented which is focused on utilizing motion of some of the torso's degrees of freedom to optimize the arm's posture according to a posture-related cost function. Thirdly a set of tasks is presented which enables contact force control at the end-effector for force-based manipulation. In addition to this final set of tasks, a higher-level controller is presented which detects external forces acting on the robot and computes a desired shift of the position of the robot's center of mass in order to mitigate the balance-disturbing effects of external forces. All of the presented sets of tasks do not exclude each other and allow to be implemented simultaneously in order to combine the individual benefits that they offer. The results of this research project show that hierarchical inverse dynamics control can be successfully applied for the control of a simulated torque-controllable quadrupedal manipulator. Moreover, it is shown that well-designed sets of prioritized control tasks allow for emergent whole-body behaviors which exploit the advantages that both the robotic system and the control framework offer. Future work will need to investigate the transferability of these results to a physical robot.

[1]  Jun-Ho Oh,et al.  Backward Ladder Climbing Locomotion of Humanoid Robot with Gain Overriding Method on Position Control , 2016, J. Field Robotics.

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

[3]  Roland Siegwart,et al.  Starleth: A compliant quadrupedal robot for fast, efficient, and versatile locomotion , 2012 .

[4]  Christopher G. Atkeson,et al.  Dynamic Balance Force Control for compliant humanoid robots , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Shinji Kawatsuma,et al.  Emergency response by robots to Fukushima-Daiichi accident: summary and lessons learned , 2012, Ind. Robot.

[6]  Alexander Herzog,et al.  Experiments with a hierarchical inverse dynamics controller on a torque-controlled humanoid , 2013 .

[7]  Alexander Dietrich,et al.  Integration of Reactive, Torque-Based Self-Collision Avoidance Into a Task Hierarchy , 2012, IEEE Transactions on Robotics.

[8]  Peter Fankhauser,et al.  Robust Rough-Terrain Locomotion with a Quadrupedal Robot , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Oscar Efrain Ramos Ponce Generation of the whole-body motion for humanoid robots with the complete dynamics. (Génération du mouvement du corps entier pour les robots humanoïdes avec la dynamique complets) , 2014 .

[10]  Tsuneo Yoshikawa,et al.  Manipulability of Robotic Mechanisms , 1985 .

[11]  Bernd Henze,et al.  Passivity-based whole-body balancing for torque-controlled humanoid robots in multi-contact scenarios , 2016, Int. J. Robotics Res..

[12]  Michael Murphy,et al.  Dynamic whole-body robotic manipulation , 2013, Defense, Security, and Sensing.

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

[14]  Siddhartha S. Srinivasa,et al.  CHIMP, the CMU Highly Intelligent Mobile Platform , 2015, J. Field Robotics.

[15]  Alexander Herzog,et al.  Momentum control with hierarchical inverse dynamics on a torque-controlled humanoid , 2014, Autonomous Robots.

[16]  Claude Samson,et al.  Robot Control: The Task Function Approach , 1991 .

[17]  Peter Fankhauser,et al.  Perception-less terrain adaptation through whole body control and hierarchical optimization , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[18]  Darwin G. Caldwell,et al.  CENTAUR ROBOTS - A SURVEY , 2017 .

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

[20]  Oussama Khatib,et al.  Control of Free-Floating Humanoid Robots Through Task Prioritization , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[21]  Darwin G. Caldwell,et al.  Towards a multi-legged mobile manipulator , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[22]  Darwin G. Caldwell,et al.  High-slope terrain locomotion for torque-controlled quadruped robots , 2016, Autonomous Robots.

[23]  Twan Koolen,et al.  Design of a Momentum-Based Control Framework and Application to the Humanoid Robot Atlas , 2016, Int. J. Humanoid Robotics.

[24]  Nikolaos G. Tsagarakis,et al.  COMpliant huMANoid COMAN: Optimal joint stiffness tuning for modal frequency control , 2013, 2013 IEEE International Conference on Robotics and Automation.

[25]  Darwin G. Caldwell,et al.  Planning and execution of dynamic whole-body locomotion for a hydraulic quadruped on challenging terrain , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[26]  Sangbae Kim,et al.  Online Planning for Autonomous Running Jumps Over Obstacles in High-Speed Quadrupeds , 2015, Robotics: Science and Systems.

[27]  Keiji Nagatani,et al.  Motion planning for mobile manipulator with keeping manipulability , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Ashish Dutta,et al.  Non-holonomic mobile manipulator kinematic control using hybrid simulated annealing , 2015, 2015 IEEE International WIE Conference on Electrical and Computer Engineering (WIECON-ECE).

[29]  Peter Fankhauser,et al.  Dynamic locomotion and whole-body control for quadrupedal robots , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[30]  Peter Fankhauser,et al.  ANYmal - a highly mobile and dynamic quadrupedal robot , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[31]  Wan Kyun Chung,et al.  Computation of Gradient of Manipulability for Kinematically Redundant manipulators Including Dual Manipulators System , 1999 .

[32]  R. Du,et al.  What Happened at the DARPA Robotics Challenge , and Why ? , 2015 .

[33]  Stefan Schaal,et al.  Fast, robust quadruped locomotion over challenging terrain , 2010, 2010 IEEE International Conference on Robotics and Automation.

[34]  Oussama Khatib,et al.  Synthesis and control of whole-body behaviors in humanoid systems , 2007 .

[35]  Miomir Vukobratovic,et al.  Zero-Moment Point - Thirty Five Years of its Life , 2004, Int. J. Humanoid Robotics.

[36]  C. Atkeson,et al.  Optimization based controller design and implementation for the Atlas robot in the DARPA Robotics Challenge Finals , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[37]  Marco Hutter,et al.  ANYpulator: Design and control of a safe robotic arm , 2016, IROS 2016.

[38]  J. Buchli,et al.  HyQ-A Dynamic Locomotion Research Platform , 2011 .

[39]  Pierre-Brice Wieber,et al.  Hierarchical quadratic programming: Fast online humanoid-robot motion generation , 2014, Int. J. Robotics Res..

[40]  Marco Hutter,et al.  Planning and Control for Autonomous Excavation , 2017, IEEE Robotics and Automation Letters.

[41]  Hannes Sommer,et al.  Quadrupedal locomotion using hierarchical operational space control , 2014, Int. J. Robotics Res..

[42]  Stefan Schaal,et al.  Optimal distribution of contact forces with inverse-dynamics control , 2013, Int. J. Robotics Res..

[43]  Hannes Sommer,et al.  A Primer on the Differential Calculus of 3D Orientations , 2016, ArXiv.

[44]  Alin Albu-Schäffer,et al.  Overview of the torque-controlled humanoid robot TORO , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.