Koopman Operator Method for Chance-Constrained Motion Primitive Planning

The use of motion primitives to plan trajectories has received significant attention in the robotics literature. This work considers the application of motion primitives to path planning and obstacle avoidance problems in which the system is subject to significant parametric and/or initial condition uncertainty. In problems involving parametric uncertainty, optimal path planning is achieved by minimizing the expected value of a cost function subject to probabilistic (chance) constraints on vehicle-obstacle collisions. The Koopman operator provides an efficient means to compute expected values for systems under parametric uncertainty. In the context of motion planning, these include both the expected cost function and chance constraints. This work describes a maneuver-based planning method that leverages the Koopman operator to minimize an expected cost while satisfying user-imposed risk tolerances. The developed method is illustrated in two separate examples using a Dubins car model subject to parametric uncertainty in its dynamics or environment. Prediction of constraint violation probability is compared with a Monte Carlo method to demonstrate the advantages of the Koopman-based calculation.

[1]  Marco Pavone,et al.  Monte Carlo Motion Planning for Robot Trajectory Optimization Under Uncertainty , 2015, ISRR.

[2]  Vijay Kumar,et al.  Automated composition of motion primitives for multi-robot systems from safe LTL specifications , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Claire J. Tomlin,et al.  A hierarchical method for stochastic motion planning in uncertain environments , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Richard D. Braatz,et al.  Stochastic nonlinear model predictive control with probabilistic constraints , 2014, 2014 American Control Conference.

[5]  Clarence W. Rowley,et al.  A Data–Driven Approximation of the Koopman Operator: Extending Dynamic Mode Decomposition , 2014, Journal of Nonlinear Science.

[6]  Abhishek Halder,et al.  Dispersion Analysis in Hypersonic Flight During Planetary Entry Using Stochastic Liouville Equation , 2011 .

[7]  Igor Mezic,et al.  Linear predictors for nonlinear dynamical systems: Koopman operator meets model predictive control , 2016, Autom..

[8]  Masahiro Ono,et al.  A Probabilistic Particle-Control Approximation of Chance-Constrained Stochastic Predictive Control , 2010, IEEE Transactions on Robotics.

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

[10]  Jonathan P. How,et al.  Robust motion planning using a maneuver automation with built-in uncertainties , 2003, Proceedings of the 2003 American Control Conference, 2003..

[11]  Steven L. Brunton,et al.  Koopman Invariant Subspaces and Finite Linear Representations of Nonlinear Dynamical Systems for Control , 2015, PloS one.

[12]  Michael Nikolaou,et al.  Chance‐constrained model predictive control , 1999 .

[13]  Hui X. Li,et al.  A probabilistic approach to optimal robust path planning with obstacles , 2006, 2006 American Control Conference.

[14]  Mireille E. Broucke,et al.  A framework for multi-vehicle navigation using feedback-based motion primitives , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[15]  Francesco Borrelli,et al.  Predictive control for agile semi-autonomous ground vehicles using motion primitives , 2012, 2012 American Control Conference (ACC).

[16]  Munther A. Dahleh,et al.  Maneuver-based motion planning for nonlinear systems with symmetries , 2005, IEEE Transactions on Robotics.

[17]  Jonathan Rogers,et al.  Koopman Operator Approach to Airdrop Mission Planning Under Uncertainty , 2019, Journal of Guidance, Control, and Dynamics.

[18]  Andrzej Banaszuk,et al.  Comparison of systems with complex behavior , 2004 .

[19]  Russ Tedrake,et al.  Funnel libraries for real-time robust feedback motion planning , 2016, Int. J. Robotics Res..

[20]  Todd D. Murphey,et al.  Active Learning of Dynamics for Data-Driven Control Using Koopman Operators , 2019, IEEE Transactions on Robotics.

[21]  Satyandra K. Gupta,et al.  GPU based generation of state transition models using simulations for unmanned surface vehicle trajectory planning , 2012, Robotics Auton. Syst..

[22]  A. Charnes,et al.  Cost Horizons and Certainty Equivalents: An Approach to Stochastic Programming of Heating Oil , 1958 .

[23]  Adam R. Gerlach,et al.  Koopman Operator Approach to Optimal Control Selection Under Uncertainty , 2019, 2019 American Control Conference (ACC).

[24]  Mark Costello,et al.  Projectile Monte-Carlo Trajectory Analysis Using a Graphics Processing Unit , 2011 .

[25]  Stefan Klus,et al.  On the numerical approximation of the Perron-Frobenius and Koopman operator , 2015, 1512.05997.

[26]  Antonie J. van den Bogert,et al.  opty: Software for trajectory optimization and parameter identification using direct collocation , 2018, J. Open Source Softw..

[27]  Soon-Jo Chung,et al.  Motion primitives and 3D path planning for fast flight through a forest , 2015, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Abhishek Halder,et al.  Uncertainty quantification for stochastic nonlinear systems using Perron-Frobenius operator and Karhunen-Loève expansion , 2012, 2012 IEEE International Conference on Control Applications.

[29]  R. Bhattacharya,et al.  Hypersonic State Estimation Using the Frobenius-Perron Operator , 2011 .

[30]  Joel W. Burdick,et al.  Probabilistic Collision Checking With Chance Constraints , 2011, IEEE Transactions on Robotics.