Time-Optimal Maneuver Planning in Automatic Parallel Parking Using a Simultaneous Dynamic Optimization Approach

Autonomous parking has been a widely developed branch of intelligent transportation systems. In autonomous parking, maneuver planning is a crucial procedure that determines how intelligent the entire parking system is. This paper concerns planning time-optimal parallel parking maneuvers in a straightforward, accurate, and purely objective way. A unified dynamic optimization framework is established, which includes the vehicle kinematics, physical restrictions, collision-avoidance constraints, and an optimization objective. Interior-point method (IPM)-based simultaneous dynamic optimization methodology is adopted to solve the formulated dynamic optimization problem numerically. Given that near-feasible solutions have been widely acknowledged to ease optimizing nonlinear programs (NLPs), a critical region-based initialization strategy is proposed to facilitate the offline NLP-solving process, a lookup table-based strategy is proposed to guarantee the on-site planning performance, and a receding-horizon optimization framework is proposed for online maneuver planning. A series of parallel parking cases is tested, and simulation results demonstrate that our proposal is efficient even when the slot length is merely 10.19% larger than the car length. As a unified maneuver planner, our adopted IPM-based simultaneous dynamic optimization method can deal with any user-specified demand provided that it can be explicitly described.

[1]  Jean-Yves Fourquet,et al.  Minimum time motion of a mobile robot with two independent, acceleration-driven wheels , 1997, Proceedings of International Conference on Robotics and Automation.

[2]  Saïd Mammar,et al.  Geometric continuous-curvature path planning for automatic parallel parking , 2013, 2013 10th IEEE INTERNATIONAL CONFERENCE ON NETWORKING, SENSING AND CONTROL (ICNSC).

[3]  Andreas Kugi,et al.  Optimisation based path planning for car parking in narrow environments , 2016, Robotics Auton. Syst..

[4]  J. Sussmann,et al.  SHORTEST PATHS FOR THE REEDS-SHEPP CAR: A WORKED OUT EXAMPLE OF THE USE OF GEOMETRIC TECHNIQUES IN NONLINEAR OPTIMAL CONTROL. 1 , 1991 .

[5]  Elizabeth A. Croft,et al.  Jerk-bounded manipulator trajectory planning: design for real-time applications , 2003, IEEE Trans. Robotics Autom..

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

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

[8]  Zhijiang Shao,et al.  Time-optimal trajectory planning for tractor-trailer vehicles via simultaneous dynamic optimization , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[10]  Brian W. Kernighan,et al.  AMPL: A Modeling Language for Mathematical Programming , 1993 .

[11]  Petros A. Ioannou,et al.  On-Street and Off-Street Parking Availability Prediction Using Multivariate Spatiotemporal Models , 2015, IEEE Transactions on Intelligent Transportation Systems.

[12]  Jean-Paul Laumond,et al.  Primitives for smoothing mobile robot trajectories , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[13]  Thierry Fraichard,et al.  From Reeds and Shepp's to continuous-curvature paths , 1999, IEEE Transactions on Robotics.

[14]  P. Souéres,et al.  Shortest paths synthesis for a car-like robot , 1996, IEEE Trans. Autom. Control..

[15]  Byung Kook Kim,et al.  Efficient time-optimal two-corner trajectory planning algorithm for differential-driven wheeled mobile robots with bounded motor control inputs , 2015, Robotics Auton. Syst..

[16]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[17]  Emmanuel G. Collins,et al.  Robust automatic parallel parking in tight spaces via fuzzy logic , 2005, Robotics Auton. Syst..

[18]  Konstantin Kondak,et al.  Computation of time optimal movements for autonomous parking of non-holonomic mobile platforms , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

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

[20]  Florent Lamiraux,et al.  Smooth motion planning for car-like vehicles , 2001, IEEE Trans. Robotics Autom..

[21]  Saïd Mammar,et al.  Automatic parallel parking with geometric continuous-curvature path planning , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[22]  Zhijiang Shao,et al.  A unified motion planning method for parking an autonomous vehicle in the presence of irregularly placed obstacles , 2015, Knowl. Based Syst..

[23]  Zhijiang Shao,et al.  An incremental strategy for tractor-trailer vehicle global trajectory optimization in the presence of obstacles , 2015, 2015 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[24]  Zhijiang Shao,et al.  Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robots , 2015, Adv. Eng. Softw..

[25]  Devin J. Balkcom,et al.  Time Optimal Trajectories for Bounded Velocity Differential Drive Vehicles , 2002, Int. J. Robotics Res..

[26]  Jing-Sin Liu,et al.  Practical and flexible path planning for car-like mobile robot using maximal-curvature cubic spiral , 2005, Robotics Auton. Syst..

[27]  Shao Zhijiang,et al.  Autonomous parking: A unified motion planning framework based on simultaneous dynamic optimization , 2015, 2015 34th Chinese Control Conference (CCC).

[28]  Kok Kiong Tan,et al.  Autonomous Reverse Parking System Based on Robust Path Generation and Improved Sliding Mode Control , 2015, IEEE Transactions on Intelligent Transportation Systems.

[29]  Kang G. Shin,et al.  Minimum-time control of robotic manipulators with geometric path constraints , 1985 .

[30]  Jean-Marc Blosseville,et al.  From Traffic Signal Control Systems to Automated Driving, a Review of ITS Systems Based on a Cross Historical and Technical Perspective , 2014 .

[31]  Chuei-Tin Chang,et al.  A Simple and Efficient Initialization Strategy for Optimizing Water-Using Network Designs , 2007 .

[32]  Saïd Mammar,et al.  Automatic Parallel Parking in Tiny Spots: Path Planning and Control , 2015, IEEE Transactions on Intelligent Transportation Systems.

[33]  Huifang Wang,et al.  A Geometric Algorithm to Compute Time-Optimal Trajectories for a Bidirectional Steered Robot , 2009, IEEE Transactions on Robotics.

[34]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[35]  Zdzislaw Kowalczuk,et al.  Autonomous Driver Based on an Intelligent System of Decision-Making , 2015, Cognitive Computation.

[36]  Chun-Liang Lin,et al.  Autonomous Vehicle Parking Using Hybrid Artificial Intelligent Approach , 2009, J. Intell. Robotic Syst..

[37]  Christian Laugier,et al.  Planning sub-optimal and continuous-curvature paths for car-like robots , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[38]  Antidio Viguria,et al.  Continuous curvature path generation based on β-spline curves for parking manoeuvres , 2008, Robotics Auton. Syst..

[39]  Sebastian Thrun,et al.  Path Planning for Autonomous Vehicles in Unknown Semi-structured Environments , 2010, Int. J. Robotics Res..

[40]  Wei Cai,et al.  Perfect Parallel Parking Via Pontryagin’s Principle , 1994 .

[41]  S. Sastry,et al.  Steering nonholonomic systems using sinusoids , 1990, 29th IEEE Conference on Decision and Control.

[42]  Lorenz T. Biegler,et al.  Nonlinear Waves in Integrable and Nonintegrable Systems , 2018 .

[43]  Yoshikazu Arai,et al.  Multilayered reinforcement learning for complicated collision avoidance problems , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[44]  Qi Wang,et al.  Voronoi-Based Heuristic for Nonholonomic Search-Based Path Planning , 2014, IAS.

[45]  Darío Maravall,et al.  Multi-objective dynamic optimization with genetic algorithms for automatic parking , 2006 .

[46]  Alessandro Gasparetto,et al.  Path Planning and Trajectory Planning Algorithms: A General Overview , 2015 .