From Obstacle-Based Space Partitioning to Corridors and Path Planning. A Convex Lifting Approach

This letter proposes a novel methodology for path generation in known and congested multi-obstacle environments. Our aim is to solve an open problem in navigation within such environments: the feasible space partitioning in accordance with the distribution of obstacles. It is shown that such a partitioning is a key concept toward the generation of a corridor in cluttered environments. Once a corridor between an initial and a final position is generated, the selection of a path is considerably simplified in comparison with the methods which explore the original non-convex feasible regions of the environment. The core of the methodology presented here is the construction of a convex lifting which boils down to a convex optimization. This letter covers both the mathematical foundations and the computational details of the implementation and aims to illustrate the concepts with geometrical examples.

[1]  Ionela Prodan,et al.  Mixed-Integer Representations in Control Design: Mathematical Foundations and Applications , 2015 .

[2]  Jianqiao Yu,et al.  UAV path planning using artificial potential field method updated by optimal control theory , 2016, Int. J. Syst. Sci..

[3]  Vijay Kumar,et al.  Planning Dynamically Feasible Trajectories for Quadrotors Using Safe Flight Corridors in 3-D Complex Environments , 2017, IEEE Robotics and Automation Letters.

[4]  Behçet Açikmese,et al.  Convexification and real-time on-board optimization for agile quad-rotor maneuvering and obstacle avoidance , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  Jonathan P. How,et al.  Aircraft trajectory planning with collision avoidance using mixed integer linear programming , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

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

[7]  Walter Lucia,et al.  The obstacle avoidance motion planning problem for autonomous vehicles: A low-demanding receding horizon control scheme , 2015, Syst. Control. Lett..

[8]  Roberto Kawakami Harrop Galvão,et al.  Waypoint trajectory planning in the presence of obstacles with a tunnel-MILP approach , 2013, 2013 European Control Conference (ECC).

[9]  Rolf Findeisen,et al.  Model predictive path-following for constrained nonlinear systems , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[10]  Xu Wang,et al.  Collision avoidance of mobile robots by using initial time delays , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

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

[12]  Ion Necoara,et al.  Fully Inverse Parametric Linear/Quadratic Programming Problems via Convex Liftings , 2015 .

[13]  A. Puri A Survey of Unmanned Aerial Vehicles ( UAV ) for Traffic Surveillance , 2005 .

[14]  Kokichi Sugihara Approximation of Generalized Voronoi Diagrams by Ordinary Voronoi Diagrams , 1993, CVGIP Graph. Model. Image Process..

[15]  Richard M. Murray,et al.  DISTRIBUTED COOPERATIVE CONTROL OF MULTIPLE VEHICLE FORMATIONS USING STRUCTURAL POTENTIAL FUNCTIONS , 2002 .

[16]  Sorin Olaru,et al.  Convex Lifting: Theory and Control Applications , 2018, IEEE Transactions on Automatic Control.

[17]  Michal Kvasnica,et al.  OPTIPLAN: A Matlab Toolbox for Model Predictive Control with Obstacle Avoidance , 2017 .

[18]  Daniel E. Koditschek,et al.  Exact robot navigation using artificial potential functions , 1992, IEEE Trans. Robotics Autom..