Temporally and spatially flexible plan execution for dynamic hybrid systems

Abstract Planners developed in the Artificial Intelligence community assume that tasks in the task plans they generate will be executed predictably and reliably. This assumption provides a useful abstraction in that it lets the task planners focus on what tasks should be done, while lower-level motion planners and controllers take care of the details of how the task should be performed. While this assumption is useful in many domains, it becomes problematic when controlling physically embedded systems, where there are often delays, disturbances, and failures. The task plans do not provide enough information about allowed flexibility in task duration and hybrid state evolution. Such flexibility could be useful when deciding how to react to disturbances. An important domain where this gap has caused problems is robotics, particularly, the operation of robots in unstructured, uncertain environments. Due to the complexity of this domain, the demands of tasks to be performed, and the actuation limits of robots, knowledge about permitted flexibility in execution of a task is crucial. We address this gap through two key innovations. First, we specify a Qualitative State Plan (QSP), which supports representation of spatial and temporal flexibility with respect to tasks. Second, we extend compilation approaches developed for temporally flexible execution of discrete activity plans to work with hybrid discrete/continuous systems using a recently developed Linear Quadratic Regulator synthesis algorithm, which performs a state reachability analysis to prune infeasible trajectories, and which determines optimal control policies for feasible state regions. The resulting Model-based Executive is able to take advantage of spatial and temporal flexibility in a QSP to improve handling of disturbances. Note that in this work, we focus on execution of QSPs, and defer the problem of how they are generated. We believe the latter could be accomplished through extensions to existing task planners.

[1]  Vijay Kumar,et al.  Adaptive RRTs for Validating Hybrid Robotic Control Systems , 2004, WAFR.

[2]  Tarik Nahhal,et al.  Coverage-guided test generation for continuous and hybrid systems , 2009, Formal Methods Syst. Des..

[3]  E. Bradley,et al.  Phase-space control system design , 1993, IEEE Control Systems.

[4]  Timothy Bretl,et al.  Motion Planning for Legged Robots on Varied Terrain , 2008, Int. J. Robotics Res..

[5]  Lydia E. Kavraki,et al.  Hybrid systems: from verification to falsification by combining motion planning and discrete search , 2007, CAV.

[6]  M. Fourman Propositional Planning , 2000 .

[7]  Emilio Frazzoli,et al.  Incremental Search Methods for Reachability Analysis of Continuous and Hybrid Systems , 2004, HSCC.

[8]  Rina Dechter,et al.  Temporal Constraint Networks , 1989, Artif. Intell..

[9]  Lydia E. Kavraki,et al.  Kinodynamic Motion Planning by Interior-Exterior Cell Exploration , 2008, WAFR.

[10]  Zoran Popovic,et al.  Physically based motion transformation , 1999, SIGGRAPH.

[11]  Andreas G. Hofmann Robust execution of bipedal walking tasks from biomechanical principles , 2006 .

[12]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[13]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning with deterministic μ-calculus specifications , 2012, 2012 American Control Conference (ACC).

[14]  Huibert Kwakernaak,et al.  Linear Optimal Control Systems , 1972 .

[15]  Brian Charles Williams,et al.  Exploiting Spatial and Temporal Flexibility for Exploiting Spatial and Temporal Flexibility for Plan Execution of Hybrid, Under-actuated Systems , 2010, Cognitive Robotics.

[16]  Alberto Bemporad,et al.  The explicit linear quadratic regulator for constrained systems , 2003, Autom..

[17]  Lydia E. Kavraki,et al.  Falsification of LTL Safety Properties in Hybrid Systems , 2009, TACAS.

[18]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[19]  Lydia E. Kavraki,et al.  Sampling-based motion planning with temporal goals , 2010, 2010 IEEE International Conference on Robotics and Automation.

[20]  Federico Pecora,et al.  On mission-dependent coordination of multiple vehicles under spatial and temporal constraints , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Masahiro Ono,et al.  An Efficient Motion Planning Algorithm for Stochastic Dynamic Systems with Constraints on Probability of Failure , 2008, AAAI.

[22]  Benjamin Kuipers,et al.  Qualitative Modeling and Heterogeneous Control of Global System Behavior , 2002, HSCC.

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

[24]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[25]  Jay H. Lee,et al.  Model predictive control: past, present and future , 1999 .

[26]  Hui Li,et al.  Hybrid Planning with Temporally Extended Goals for Sustainable Ocean Observing , 2011, AAAI.

[27]  Emilio Frazzoli,et al.  Sampling-Based Resolution-Complete Algorithms for Safety Falsification of Linear Systems , 2008, HSCC.

[28]  Pierre-Brice Wieber,et al.  Author manuscript, published in "IEEE/RSJ International Conference on Intelligent Robots and Systems (2011)" A sparse model predictive control formulation for walking motion generation , 2011 .

[29]  M. Vukobratovic,et al.  On the stability of anthropomorphic systems , 1972 .

[30]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[31]  John L. Stedl,et al.  Managing temporal uncertainty under limited communication : a formal model of tight and loose team coordination , 2004 .

[32]  P. Pandurang Nayak,et al.  Remote Agent: To Boldly Go Where No AI System Has Gone Before , 1998, Artif. Intell..

[33]  Brian C. Williams,et al.  Hybrid estimation of complex systems , 2005, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[34]  Manfred Morari,et al.  Multi-Parametric Toolbox 3.0 , 2013, 2013 European Control Conference (ECC).

[35]  Marko B. Popovic,et al.  A sliding controller for bipedal balancing using integrated movement of contact and non-contact limbs , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[36]  Weiping Li,et al.  Applied Nonlinear Control , 1991 .

[37]  Nicola Muscettola,et al.  Reformulating Temporal Plans for Efficient Execution , 1998, KR.