FROST∗: Fast robot optimization and simulation toolkit

This paper presents FROST, an open-source MATLAB toolkit for modeling, trajectory optimization and simulation of hybrid dynamical systems with a particular focus in dynamic locomotion. The design objective of FROST is to provide a unified software environment for developing model-based control and motion planning algorithms for robotic systems whose dynamics is hybrid in nature. In particular, FROST uses directed graphs to describe the underlying discrete structure of hybrid system models, which renders it capable of representing a wide variety of robotic systems. Equipped with a custom symbolic math toolbox in MATLAB using Wolfram Mathematica, one can rapidly prototype the mathematical model of robot kinematics and dynamics and generate optimized code of symbolic expressions to boost the speed of optimization and simulation in FROST. In favor of agile and dynamic behaviors, we utilize virtual constraint based motion planning and feedback controllers for robotic systems to exploit the full-order dynamics of the model. Moreover, FROST provides a fast and tractable framework for planning optimal trajectories of hybrid dynamical systems using advanced direct collocation algorithms. FROST has been successfully used to synthesize dynamic walking in multiple bipedal robots. Case studies of such applications are considered in this paper, wherein different types of walking gaits are generated for two specific humanoid robots and validated in simulation.

[1]  Twan Koolen,et al.  Capturability-based analysis and control of legged locomotion, Part 2: Application to M2V2, a lower-body humanoid , 2012, Int. J. Robotics Res..

[2]  John T. Betts,et al.  Practical Methods for Optimal Control and Estimation Using Nonlinear Programming , 2009 .

[3]  Kazuhito Yokoi,et al.  The 3D linear inverted pendulum mode: a simple modeling for a biped walking pattern generation , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[4]  Scott Kuindersma,et al.  Optimization and stabilization of trajectories for constrained dynamical systems , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[5]  A Yongga,et al.  Dynamic humanoid locomotion: Hybrid zero dynamics based gait optimization via direct collocation methods , 2016 .

[6]  Aaron D. Ames,et al.  Human-Inspired Control of Bipedal Walking Robots , 2014, IEEE Transactions on Automatic Control.

[7]  Christine Chevallereau,et al.  Models, feedback control, and open problems of 3D bipedal robotic walking , 2014, Autom..

[8]  Bernard Brogliato,et al.  Modeling, stability and control of biped robots - a general framework , 2004, Autom..

[9]  John Guckenheimer,et al.  Planar Hybrid Systems , 1994, Hybrid Systems.

[10]  E. Westervelt,et al.  Feedback Control of Dynamic Bipedal Robot Locomotion , 2007 .

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

[12]  Aaron D. Ames,et al.  Algorithmic Foundations of Realizing Multi-Contact Locomotion on the Humanoid Robot DURUS , 2016, WAFR.

[13]  Anil V. Rao,et al.  Practical Methods for Optimal Control Using Nonlinear Programming , 1987 .

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

[15]  Koushil Sreenath,et al.  Rapidly Exponentially Stabilizing Control Lyapunov Functions and Hybrid Zero Dynamics , 2014, IEEE Transactions on Automatic Control.

[16]  Ayush Agrawal,et al.  First Steps Towards Translating HZD Control of Bipedal Robots to Decentralized Control of Exoskeletons , 2017, IEEE Access.

[17]  Olivier Stasse,et al.  A versatile and efficient pattern generator for generalized legged locomotion , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[18]  Andrea Lockerd Thomaz,et al.  Work those arms: Toward dynamic and stable humanoid walking that optimizes full-body motion , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[20]  Alexander Herzog,et al.  Trajectory generation for multi-contact momentum control , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[21]  Victor M. Becerra,et al.  Solving complex optimal control problems at no cost with PSOPT , 2010, 2010 IEEE International Symposium on Computer-Aided Control System Design.

[22]  Michael A. Saunders,et al.  SNOPT: An SQP Algorithm for Large-Scale Constrained Optimization , 2002, SIAM J. Optim..

[23]  Aaron D. Ames,et al.  Efficient HZD gait generation for three-dimensional underactuated humanoid running , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[24]  Russ Tedrake,et al.  Whole-body motion planning with centroidal dynamics and full kinematics , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[25]  Anil V. Rao,et al.  GPOPS-II , 2014, ACM Trans. Math. Softw..