Semi-analytical minimum time solutions with velocity constraints for trajectory following of vehicles

Abstract We consider the problem of finding an optimal manoeuvre that moves a car-like vehicle between two configurations in minimum time. We propose a two phase algorithm in which a path that joins the two points is first found by solving a geometric optimisation problem, and then the optimal manoeuvre is identified considering the system dynamics and its constraints. We make the assumption that the path is composed of a sequence of clothoids. This choice is justified by theoretical arguments, practical examples and by the existence of very efficient geometric algorithms for the computation of a path of this kind. The focus of the paper is on the computation of the optimal manoeuvre, for which we show a semi-analytical solution that can be produced in a few milliseconds on an embedded platform for a path made of one hundred segments. Our method is considerably faster than approaches based on pure numerical solutions, it is capable to detect when the optimal solution exists and, in this case, compute the optimal control. Finally, the method explicitly considers nonlinear dynamics, aerodynamic drag effect and bounds on the longitudinal and on the lateral acceleration.

[1]  Timothy W. McLain,et al.  Real-time dynamic trajectory smoothing for unmanned air vehicles , 2005, IEEE Transactions on Control Systems Technology.

[2]  Emilio Frazzoli,et al.  Anytime Motion Planning using the RRT* , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[4]  Francesco Biral,et al.  Notes on Numerical Methods for Solving Optimal Control Problems , 2016 .

[5]  J. Frédéric Bonnans,et al.  Second-order analysis for optimal control problems with pure state constraints and mixed control-state constraints , 2009 .

[6]  Enrico Bertolazzi,et al.  Semianalytical minimum‐time solution for the optimal control of a vehicle subject to limited acceleration , 2016, 1603.06245.

[7]  Luigi Palopoli,et al.  Global path planning for competitive robotic cars , 2013, 52nd IEEE Conference on Decision and Control.

[8]  Anil V. Rao,et al.  GPOPS-II , 2014, ACM Trans. Math. Softw..

[9]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[10]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[11]  Luigi Palopoli,et al.  Semi-analytical minimum time solutions for a vehicle following clothoid-based trajectory subject to velocity constraints , 2016, 2016 European Control Conference (ECC).

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

[13]  Le-ping Yang,et al.  Bang‐bang optimal control for differentially flat systems using mapped pseudospectral method and analytic homotopic approach , 2016 .

[14]  Roberto Lot,et al.  Lap time optimisation of a racing go-kart , 2016 .

[15]  Davide Tavernini,et al.  Minimum time cornering: the effect of road surface and car transmission layout , 2013 .

[16]  P. Tsiotras,et al.  Minimum-Time Travel for a Vehicle with Acceleration Limits: Theoretical Analysis and Receding-Horizon Implementation , 2008 .

[17]  Luigi Palopoli,et al.  Trajectory planning for car-like vehicles: A modular approach , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[18]  De-Bao Sun,et al.  Path planning for mobile robot using the particle swarm optimization with mutation operator , 2004, Proceedings of 2004 International Conference on Machine Learning and Cybernetics (IEEE Cat. No.04EX826).

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

[20]  Debasish Ghose,et al.  Optimal transition trajectory for waypoint following , 2013, 2013 IEEE International Conference on Control Applications (CCA).

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

[22]  John R. Hauser,et al.  Motorcycle modeling for high-performance maneuvering , 2006, IEEE Control Systems.

[23]  David Windridge,et al.  Artificial Co-Drivers as a Universal Enabling Technology for Future Intelligent Vehicles and Transportation Systems , 2015, IEEE Transactions on Intelligent Transportation Systems.

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

[25]  Maria Letizia Corradini,et al.  Switching linear path following for bounded curvature car-like vehicles , 2004 .

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

[27]  Mauro Da Lio,et al.  On the human control of vehicles: an experimental study of acceleration , 2013, European Transport Research Review.

[28]  William Whittaker,et al.  Autonomous driving in urban environments: Boss and the Urban Challenge , 2008, J. Field Robotics.

[29]  Francesco Biral,et al.  Supporting Drivers in Keeping Safe Speed and Safe Distance: The SASPENCE Subproject Within the European Framework Programme 6 Integrating Project PReVENT , 2010, IEEE Transactions on Intelligent Transportation Systems.

[30]  D. Jacobson,et al.  New necessary conditions of optimality for control problems with state-variable inequality constraints , 1971 .

[31]  Charles Richter,et al.  Polynomial Trajectory Planning for Aggressive Quadrotor Flight in Dense Indoor Environments , 2016, ISRR.

[32]  N. Flocke,et al.  Algorithm 954 , 2015 .

[33]  Ricardo G. Sanfelice,et al.  On minimum-time paths of bounded curvature with position-dependent constraints , 2013, Autom..

[34]  David J. N. Limebeer,et al.  Optimal control for a Formula One car with variable parameters , 2014 .

[35]  Alberto Broggi,et al.  Extensive Tests of Autonomous Driving Technologies , 2013, IEEE Transactions on Intelligent Transportation Systems.

[36]  Francesco Biral,et al.  Intersection Support System for Powered Two-Wheeled Vehicles: Threat Assessment Based on a Receding Horizon Approach , 2012, IEEE Transactions on Intelligent Transportation Systems.

[37]  Zvi Shiller,et al.  Robust computation of path constrained time optimal motions , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[38]  Nathan A. Greenblatt,et al.  Self-driving cars and the law , 2016, IEEE Spectrum.

[39]  E. Bertolazzi,et al.  G1 fitting with clothoids , 2015 .

[40]  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).