Robust hybrid control for autonomous vehicle motion planning

The operation of an autonomous vehicle in an unknown, dynamic environment is a very complex problem, especially when the vehicle is required to use its full maneuvering capabilities, and to react in real time to changes in the operational environment. A possible approach to reduce the computational complexity of the motion planning problem for a nonlinear, high dimensional system, is based on a quantization of the system dynamics, leading to a control architecture based on a hybrid automaton, the states of which represent feasible trajectory primitives for the vehicle. The paper focuses on the feasibility of this approach, in the presence of disturbances and uncertainties in the plant and/or in the environment: the structure of a robust hybrid automaton is defined and its properties are analyzed. In particular, we address the issues of well-posedness, consistency and reachability. For the case of autonomous vehicles, we provide sufficient conditions to guarantee reachability of the automaton.

[1]  L. Dubins.  On Curves of Minimal Length with a Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents , 1957 .

[2]  J. Davenport.  Editor , 1960 .

[3]  L. S. Pontryagin,et al.  Mathematical Theory of Optimal Processes , 1962 .

[4]  M. L. Chambers.  The Mathematical Theory of Optimal Processes , 1965 .

[5]  R. Bellman.  Dynamic programming. , 1957, Science.

[6]  Michael Athans,et al.  Optimal Control , 1966 .

[7]  D. Luenberger.  Optimization by Vector Space Methods , 1968 .

[8]  Arthur E. Bryson,et al.  Applied Optimal Control , 1969 .

[9]  T. Mckeown.  Mechanics , 1970, The Mathematics of Fluid Flow Through Porous Media.

[10]  H. Sussmann,et al.  Controllability of nonlinear systems , 1972 .

[11]  V. Arnold.  Mathematical Methods of Classical Mechanics , 1974 .

[12]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).

[13]  Tomás Lozano-Pérez,et al.  An algorithm for planning collision-free paths among polyhedral obstacles , 1979, CACM.

[14]  C. A. Desoer,et al.  Nonlinear Systems Analysis , 1978 .

[15]  Tomás Lozano-Pérez,et al.  Automatic Planning of Manipulator Transfer Movements , 1981, IEEE Transactions on Systems, Man, and Cybernetics.

[16]  Z. Artstein.  Stabilization with relaxed controls , 1983 .

[17]  J. Schwartz,et al.  On the “piano movers'” problem I. The case of a two‐dimensional rigid polygonal body moving amidst polygonal barriers , 1983 .

[18]  Robert L. Shaw,et al.  Fighter Combat: Tactics and Maneuvering , 1985 .

[19]  Chee-Keng Yap,et al.  A "Retraction" Method for Planning the Motion of a Disc , 1985, J. Algorithms.

[20]  A. Isidori.  Nonlinear Control Systems , 1985 .

[21]  Editors , 1986, Brain Research Bulletin.

[22]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[23]  Raymond W. Prouty,et al.  Helicopter performance, stability, and control , 1986 .

[24]  Herbert Edelsbrunner,et al.  Algorithms in Combinatorial Geometry , 1987, EATCS Monographs in Theoretical Computer Science.

[25]  C. Hargraves,et al.  DIRECT TRAJECTORY OPTIMIZATION USING NONLINEAR PROGRAMMING AND COLLOCATION , 1987 .

[26]  John Canny,et al.  The complexity of robot motion planning , 1988 .

[27]  李幼升,et al.  Ph , 1989 .

[28]  D. Koditschek.  The Application of Total Energy as a Lyapunov Function for Mechanical Control Systems , 1989 .

[29]  Roger W. Brockett.  On the rectification of vibratory motion , 1989 .

[30]  Eduardo Sontag.  A universal construction of Artstein's theorem on nonlinear stabilization , 1989 .

[31]  Michael Lewis,et al.  Game theory for automated maneuvering during air-to-air combat , 1990 .

[32]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[33]  Eduardo Sontag,et al.  Controllability of Nonlinear Discrete-Time Systems: A Lie-Algebraic Approach , 1990, SIAM Journal on Control and Optimization.

[34]  Arjan van der Schaft,et al.  Non-linear dynamical control systems , 1990 .

[35]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[36]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[37]  Narendra Ahuja,et al.  A potential field approach to path planning , 1992, IEEE Trans. Robotics Autom..

[38]  Philippe Martin.  Contribution a l'etude des systemes differentiellement plats , 1992 .

[39]  J. Canny,et al.  Nonholonomic Motion Planning , 1992 .

[40]  Thomas A. Henzinger,et al.  Hybrid Automata: An Algorithmic Approach to the Specification and Verification of Hybrid Systems , 1992, Hybrid Systems.

[41]  Frank L. Lewis,et al.  Aircraft Control and Simulation , 1992 .

[42]  M. Fliess,et al.  Sur les systèmes non linéaires différentiellement plats , 1992 .

[43]  P. Gács,et al.  Algorithms , 1992 .

[44]  D. Normand-Cyrot,et al.  An introduction to motion planning under multirate digital control , 1992, [1992] Proceedings of the 31st IEEE Conference on Decision and Control.

[45]  Gerardo Lafferriere,et al.  A Differential Geometric Approach to Motion Planning , 1993 .

[46]  Jeff S. Shamma,et al.  Gain-Scheduled Missile Autopilot Design Using Linear Parameter Varying Transformations , 1993 .

[47]  Robert F. Stengel,et al.  Toward intelligent flight control , 1993, IEEE Trans. Syst. Man Cybern..

[48]  M. Fliess,et al.  Flatness, motion planning and trailer systems , 1993, Proceedings of 32nd IEEE Conference on Decision and Control.

[49]  Jean-Paul Laumond,et al.  Singularities and Topological Aspects in Nonholonomic Motion Planning , 1993 .

[50]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

[51]  Stephen P. Boyd,et al.  Linear Matrix Inequalities in Systems and Control Theory , 1994 .

[52]  J. Marsden,et al.  Introduction to mechanics and symmetry , 1994 .

[53]  Woojin Chung,et al.  Design of a nonholonomic manipulator , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

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

[55]  S. Sastry,et al.  Optimal path planning on matrix Lie groups , 1994, Proceedings of 1994 33rd IEEE Conference on Decision and Control.

[56]  G. D. Padfield,et al.  Helicopter Flight Dynamics: The Theory and Application of Flying Qualities and Simulation Modelling , 1995 .

[57]  M. H. Overmars,et al.  A paradigm for probabilistic path planning , 1995 .

[58]  T. Henzinger,et al.  Algorithmic Analysis of Nonlinear Hybrid Systems , 1998, CAV.

[59]  M. Dahleh,et al.  Control of Uncertain Systems: A Linear Programming Approach , 1995 .

[60]  Thomas A. Henzinger,et al.  The Algorithmic Analysis of Hybrid Systems , 1995, Theor. Comput. Sci..

[61]  Miroslav Krstic,et al.  Nonlinear and adaptive control de-sign , 1995 .

[62]  John R. Hauser,et al.  Maneuver Regulation from Trajectory Tracking: Feedback Linearizable Systems * , 1995 .

[63]  S. Sastry,et al.  Hybrid Control in Air Traac Management Systems , 1995 .

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

[65]  George J. Pappas,et al.  Hybrid control in air traffic management systems , 1995, Proceedings of 1995 34th IEEE Conference on Decision and Control.

[66]  Nancy A. Lynch,et al.  Hybrid I/O automata , 1995, Inf. Comput..

[67]  Zvi Shiller,et al.  Trajectory Preshaping for High-Speed Articulated Systems , 1995 .

[68]  Philippe Martin,et al.  AIRCRAFT CONTROL USING FLATNESS , 1996 .

[69]  Michael S. Branicky,et al.  Studies in hybrid systems: modeling, analysis, and control , 1996 .

[70]  A different look at output tracking: control of a vtol aircraft , 1996, Autom..

[71]  John-Morten Godhavn,et al.  Nonlinear tracking of underactuated surface vessels , 1996, Proceedings of 35th IEEE Conference on Decision and Control.

[72]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[73]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[74]  John N. Tsitsiklis,et al.  Neuro-Dynamic Programming , 1996, Encyclopedia of Machine Learning.

[75]  Richard M. Murray,et al.  Real Time Trajectory Generation for Differentially Flat Systems , 1996 .

[76]  Zvi Shiller,et al.  The practical implementation of time-optimal control for robotic manipulators , 1996 .

[77]  Lydia E. Kavraki,et al.  Analysis of probabilistic roadmaps for path planning , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[78]  John Lygeros,et al.  Hierarchical, Hybrid Control of Large Scale Systems , 1996 .

[79]  J. Doyle,et al.  Robust and optimal control , 1995, Proceedings of 35th IEEE Conference on Decision and Control.

[80]  P. Kokotovic,et al.  Inverse Optimality in Robust Stabilization , 1996 .

[81]  N. H. McClamroch,et al.  A hybrid switched mode control approach for V/STOL flight control problems , 1996, Proceedings of 35th IEEE Conference on Decision and Control.

[82]  P. Krishnaprasad,et al.  Nonholonomic mechanical systems with symmetry , 1996 .

[83]  W. Brockett,et al.  Minimum attention control , 1997, Proceedings of the 36th IEEE Conference on Decision and Control.

[84]  Alexander Leonessa,et al.  Globally stabilizing controllers for multi-mode axial flow compressors via equilibria-dependent Lyapunov functions , 1997, Proceedings of the 1997 American Control Conference (Cat. No.97CH36041).

[85]  George J. Pappas,et al.  Con ict Resolution for Air Tra c Management: a Study in Multi-Agent Hybrid Systems , 1997 .

[86]  José Eduardo Ribeiro Cury,et al.  Towards Using Hybrid Automata for the Mission Planning of Unmanned Aerial Vehicles , 1997, Hybrid Systems.

[87]  J. Latombe,et al.  Probabilistic Roadm Aps for Path Planning in High-dimensional Connguration Spaces , 1997 .

[88]  Naomi Ehrich Leonard,et al.  Stabilization of mechanical systems using controlled Lagrangians , 1997, Proceedings of the 36th IEEE Conference on Decision and Control.

[89]  Kurt Mehlhorn,et al.  The LEDA Platform of Combinatorial and Geometric Computing , 1997, ICALP.

[90]  J. Marsden,et al.  Optimal Control for Holonomic and Nonholonomic Mechanical Systems with Symmetry and Lagrangian Reduction , 1997 .

[91]  Douglas Thomson,et al.  Mathematical Definition of Helicopter Maneuvers , 1997 .

[92]  E. Feron,et al.  Hierarchical control of small autonomous helicopters , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[93]  S. Shankar Sastry,et al.  Conflict resolution for air traffic management: a study in multiagent hybrid systems , 1998, IEEE Trans. Autom. Control..

[94]  Anthony J. Calise,et al.  A full authority helicopter adaptive neuro-controller , 1998, 1998 IEEE Aerospace Conference Proceedings (Cat. No.98TH8339).

[95]  Lydia E. Kavraki,et al.  On finding narrow passages with probabilistic roadmap planners , 1998 .

[96]  Antonio Bicchi,et al.  Steering driftless nonholonomic systems by control quanta , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[97]  John Lygeros,et al.  Verified hybrid controllers for automated vehicles , 1998, IEEE Trans. Autom. Control..

[98]  S. Sastry,et al.  Output tracking control design of a helicopter model based on approximate linearization , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[99]  H. Shim,et al.  A comprehensive study of control design for an autonomous helicopter , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[100]  J. Betts.  Survey of Numerical Methods for Trajectory Optimization , 1998 .

[101]  E. Yaz.  Linear Matrix Inequalities In System And Control Theory , 1998, Proceedings of the IEEE.

[102]  Mark W. Spong,et al.  Underactuated mechanical systems , 1998 .

[103]  S. Shankar Sastry,et al.  Aerodynamic envelope protection using hybrid control , 1998, Proceedings of the 1998 American Control Conference. ACC (IEEE Cat. No.98CH36207).

[104]  Jean-Paul Laumond,et al.  Robot Motion Planning and Control , 1998 .

[105]  Lydia E. Kavraki,et al.  Randomized Query Processing in Robot Path Planning , 1998, J. Comput. Syst. Sci..

[106]  Bruno Sinopoli,et al.  Hybrid Control of an Autonomous Helicopter , 1998 .

[107]  Lydia E. Kavraki,et al.  Probabilistic Roadmaps for Robot Path Planning , 1998 .

[108]  Bo Egardt,et al.  Control design for integrator hybrid systems , 1998, IEEE Trans. Autom. Control..

[109]  Richard M. Murray,et al.  Rapid Hover-to-Forward-Flight Transitions for a Thrust-Vectored Aircraft , 1998 .

[110]  T. Henzinger,et al.  Algorithmic analysis of nonlinear hybrid systems , 1998, IEEE Trans. Autom. Control..

[111]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[112]  John Lygeros,et al.  Synthesizing Controllers for Nonlinear Hybrid Systems , 1998, HSCC.

[113]  Philippe Souères,et al.  Optimal trajectories for nonholonomic mobile robots , 1998 .

[114]  Carlos Silvestre,et al.  Trajectory Tracking for Autonomous Vehicles: An Integrated Approach to Guidance and Control , 1998 .

[115]  Daniel E. Koditschek,et al.  Sequential Composition of Dynamically Dexterous Robot Behaviors , 1999, Int. J. Robotics Res..

[116]  F. Bullo.  Nonlinear control of mechanical systems : a Riemannian geometry approach , 1999 .

[117]  P. Rouchon,et al.  Invariant tracking and stabilization: problem formulation and examples , 1999 .

[118]  Emilio Frazzoli,et al.  A hybrid control architecture for aggressive maneuvering of autonomous helicopters , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[119]  Claire J. Tomlin,et al.  Switched nonlinear control of a VSTOL aircraft , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[120]  Gregory E. Chamitoff,et al.  Autonomous Maneuver Tracking for Self-Piloted Vehicles , 1999 .

[121]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[122]  Jean-Claude Latombe,et al.  Motion Planning: A Journey of Robots, Molecules, Digital Actors, and Other Artifacts , 1999, Int. J. Robotics Res..

[123]  Richard M. Murray,et al.  Tracking for fully actuated mechanical systems: a geometric framework , 1999, Autom..

[124]  Eric Feron,et al.  High performance control with position and rate limited actuators , 1999 .

[125]  Mario Innocenti,et al.  Helicopter Flight Dynamics: The Theory and Application of Flying Qualities and Simulation Modeling , 1999 .

[126]  Rajeev Motwani,et al.  Path Planning in Expansive Configuration Spaces , 1999, Int. J. Comput. Geom. Appl..

[127]  S. Sastry.  Nonlinear Systems: Analysis, Stability, and Control , 1999 .

[128]  John Lygeros,et al.  Controllers for reachability specifications for hybrid systems , 1999, Autom..

[129]  C. Tomlin,et al.  Controllers for Reachability Speciications for Hybrid Systems , 1999 .

[130]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[131]  Emilio Frazzoli,et al.  A Hybrid Control Architecture for Aggressive Maneuvering of Autonomous Aerial Vehicles , 2000 .

[132]  Emilio Frazzoli,et al.  Real-Time Motion Planning for Agile Autonomous Vehicles , 2000 .

[133]  Munther A. Dahleh,et al.  A computationally efficient Lyapunov-based scheduling procedure for control of nonlinear systems with stability guarantees , 2000, IEEE Trans. Autom. Control..

[134]  Mark B. Milam,et al.  A new computational approach to real-time trajectory generation for constrained mechanical systems , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[135]  A. Marigo,et al.  Reachability analysis for a class of quantized control systems , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[136]  Steven M. LaValle,et al.  Robot Motion Planning: A Game-Theoretic Foundation , 2000, Algorithmica.

[137]  S. Shankar Sastry,et al.  Hierarchically consistent control systems , 2000, IEEE Trans. Autom. Control..

[138]  George J. Pappas,et al.  Consistent hierarchies of nonlinear abstractions , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[139]  Eric Feron,et al.  Aggressive Maneuvering of Autonomous Aerial Vehicles: A Human-Centered Approach , 2000 .

[140]  Naomi Ehrich Leonard,et al.  Controllability and motion algorithms for underactuated Lagrangian systems on Lie groups , 2000, IEEE Trans. Autom. Control..

[141]  Antonio Bicchi,et al.  Rolling bodies with regular surface: controllability theory and applications , 2000, IEEE Trans. Autom. Control..

[142]  R. Murray,et al.  Trajectory Planning of Differentially Flat Systems with Dynamics and Inequalities , 2000 .

[143]  Nicola Elia,et al.  Stabilization of linear systems with limited information , 2001, IEEE Trans. Autom. Control..

[144]  Munther A. Dahleh,et al.  Global stability of relay feedback systems , 2001, IEEE Trans. Autom. Control..

[145]  Nancy A. Lynch,et al.  Hybrid I/O Automata Revisited , 2001, HSCC.

[146]  Emilio Frazzoli,et al.  Aggressive Maneuvering of Small Autonomous Helicopters: A Human-Centered Approach , 2001, Int. J. Robotics Res..

[147]  Kevin M. Lynch,et al.  Kinematic controllability and decoupled trajectory planning for underactuated mechanical systems , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[148]  Reza Olfati-Saber,et al.  Normal forms for underactuated mechanical systems with symmetry , 2002, IEEE Trans. Autom. Control..

[149]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..