HierarchicalTrajectoryOptimization inHybridDynamical Systems

We discuss trajectory optimization for hybrid systems with a natural, hierarchical separation of discrete and continuous dynamics. The trajectory optimization problem considered requires that a discrete state sequence and a continuous state trajectory must be both determined to minimize a single cost function, such that the discrete state sequence also solves a symbolic planning problem. We model this symbolic planning problem as a search on a planning graph, and we introduce a family of graphs called lifted planning graphs parametrized by an integer H. We define a family of continuous state trajectory optimization problems and associate them with edge costs in the lifted planning graphs. Next, we present an algorithm for finding an optimal solution to the hybrid trajectory optimization problem, which includes mapping paths in the lifted planning graphs to discrete state sequences and continuous state trajectories. We show that the cost of optimal hybrid trajectories is a nonincreasing function of H, and that there exists a finite H for which this cost attains a minimum. We illustrate the proposed algorithm with numerical simulation results for two application examples: an autonomous mobile vehicle and an autonomous robotic manipulator.

[1]  Peter Norvig,et al.  Artificial Intelligence: A Modern Approach , 1995 .

[2]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[3]  Benedetto Piccoli,et al.  Hybrid systems and optimal control , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[4]  M. Branicky.  Multiple Lyapunov functions and other analysis tools for switched and hybrid systems , 1998, IEEE Trans. Autom. Control..

[5]  H. Sussmann,et al.  A maximum principle for hybrid optimal control problems , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[6]  O. Stursberg,et al.  Continuous-discrete interactions in chemical processing plants , 2000, Proceedings of the IEEE.

[7]  George J. Pappas,et al.  Discrete abstractions of hybrid systems , 2000, Proceedings of the IEEE.

[8]  Sung Yong Shin,et al.  Approximation of Curvature-Constrained Shortest Paths through a Sequence of Points , 2000, ESA.

[9]  Christos G. Cassandras,et al.  Optimal control of a class of hybrid systems , 2001, IEEE Trans. Autom. Control..

[10]  Anders Rantzer,et al.  Convex dynamic programming for hybrid systems , 2002, IEEE Trans. Autom. Control..

[11]  Xuping Xu,et al.  Optimal control of switched systems via non-linear optimization based on direct differentiations of value functions , 2002 .

[12]  Daniel Liberzon,et al.  Switching in Systems and Control , 2003, Systems & Control: Foundations & Applications.

[13]  N. Shimkin,et al.  Fast Graph-Search Algorithms for General-Aviation Flight Trajectory Generation , 2005 .

[14]  M. Spong,et al.  Robot Modeling and Control , 2005 .

[15]  B. Piccoli,et al.  Hybrid Necessary Principle , 2005, CDC/ECC.

[16]  Alberto Bemporad,et al.  Logic-based solution methods for optimal control of hybrid systems , 2006, IEEE Transactions on Automatic Control.

[17]  Wassim M. Haddad,et al.  Impulsive and Hybrid Dynamical Systems: Stability, Dissipativity, and Control , 2006 .

[18]  Peter E. Caines,et al.  On the Hybrid Optimal Control Problem: Theory and Algorithms , 2007, IEEE Transactions on Automatic Control.

[19]  Antonio Bicchi,et al.  Symbolic planning and control of robot motion [Grand Challenges of Robotics] , 2007, IEEE Robotics & Automation Magazine.

[20]  Erik I. Verriest,et al.  Gradient Descent Approach to Optimal Mode Scheduling in Hybrid Dynamical Systems , 2008 .

[21]  G. Barles,et al.  UNBOUNDED VISCOSITY SOLUTIONS OF HYBRID CONTROL SYSTEMS , 2008, 0802.1988.

[22]  W. Haddad,et al.  Nonlinear Dynamical Systems and Control: A Lyapunov-Based Approach , 2008 .

[23]  S. Sager.  Reformulations and algorithms for the optimization of switching decisions in nonlinear optimal control , 2009 .

[24]  Paulo Tabuada,et al.  Verification and Control of Hybrid Systems - A Symbolic Approach , 2009 .

[25]  Magnus Egerstedt,et al.  On-Line Optimization of Switched-Mode Dynamical Systems , 2009, IEEE Transactions on Automatic Control.

[26]  William W. Hager,et al.  A unified framework for the numerical solution of optimal control problems using pseudospectral methods , 2010, Autom..

[27]  O. Stursberg,et al.  A numerical method for hybrid optimal control based on dynamic programming , 2011 .

[28]  Maryam Kamgarpour,et al.  On optimal control of non-autonomous switched systems with a fixed mode sequence , 2012, Autom..

[29]  Sebastian Engell,et al.  Optimal operation: Scheduling, advanced control and their integration , 2012, Comput. Chem. Eng..

[30]  Ricardo G. Sanfelice,et al.  Hybrid Dynamical Systems: Modeling, Stability, and Robustness , 2012 .

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

[32]  Ricardo G. Sanfelice,et al.  On the Existence of Control Lyapunov Functions and State-Feedback Laws for Hybrid Systems , 2013, IEEE Transactions on Automatic Control.

[33]  Panos J. Antsaklis,et al.  Optimal Control of Switched Hybrid Systems: A Brief Survey , 2013 .

[34]  Raghvendra V. Cowlagi.  Hierarchical Hybrid Control with Classical Planning and Trajectory Optimization , 2015, ADHS.

[35]  Peter E. Caines,et al.  Time Optimal Hybrid Minimum Principle and the Gear Changing Problem for Electric Vehicles , 2015, ADHS.

[36]  Peter E. Caines,et al.  On the Relation between the Hybrid Minimum Principle and Hybrid Dynamic Programming: a Linear Quadratic Example , 2015, ADHS.