An optimal hierarchical framework of the trajectory following by convex optimisation for highly automated driving vehicles

ABSTRACT This paper presents a hierarchical trajectory following framework for SAE-level 2/3 automatic driving by convex optimisation, which aims for daily common driving manoeuvres with low traffics on the highway, such as free driving, adaptively following and overtaking. More specifically, it includes several combined functionalities of lane keeping, adaptive following, active obstacle avoidance and speed adaptation. The trajectory-planning module would generate the optimal path and speed profiles for the structure road (e.g. highway) with different geometric shapes, by using the natural cubic spline and convex optimisation approach. While modules of trajectory following or adaptive following are realised by a linearised time-varying model predictive control method. It is expected that the proposed framework could improve the driving safety, as well as the driving efficiency and driving comforts simultaneously. Thus, typical scenarios are designed to verify the effectiveness of the proposed trajectory following framework. Simulation results demonstrate that it could successfully deal with daily manoeuvres on a straight or curved highway without human driver's interventions.

[1]  David J. Cole,et al.  Linear quadratic game and non-cooperative predictive methods for potential application to modelling driver–AFS interactive steering control , 2013 .

[2]  John A. Michon,et al.  A critical view of driver behavior models: What do we know , 1985 .

[3]  Mathias R Lidberg,et al.  Integrated evasive manoeuvre assist for collision mitigation with oncoming vehicles , 2018 .

[4]  Robin S. Sharp,et al.  OPTIMAL PREVIEW CAR STEERING CONTROL , 2001 .

[5]  Ming Yang,et al.  Laser Radar based Vehicle Localization in GPS Signal Blocked Areas , 2011, Int. J. Comput. Intell. Syst..

[6]  Yun Shi,et al.  GPS-Supported Visual SLAM with a Rigorous Sensor Model for a Panoramic Camera in Outdoor Environments , 2012, Sensors.

[7]  Charles C. MacAdam,et al.  Application of an Optimal Preview Control for Simulation of Closed-Loop Automobile Driving , 1981, IEEE Transactions on Systems, Man, and Cybernetics.

[8]  David J. Cole,et al.  Application of linear preview control to modelling human steering control , 2009 .

[9]  Fawzi Nashashibi,et al.  Localization for intelligent vehicle by fusing mono-camera, low-cost GPS and map data , 2010, 13th International IEEE Conference on Intelligent Transportation Systems.

[10]  Yahui Liu,et al.  Research on interactive steering control strategy between driver and AFS in different game equilibrium strategies and information patterns , 2018 .

[11]  D. Casanova,et al.  A Mathematical Model for Driver Steering Control, with Design, Tuning and Performance Results , 2000 .

[12]  Michel Basset,et al.  Nonlinear cascade strategy for longitudinal control in automated vehicle guidance , 2014 .

[13]  David J. Cole,et al.  Minimum Maneuver Time Calculation Using Convex Optimization , 2013 .

[14]  S. Daniel,et al.  National Highway Traffic Safety Administration , 2020, Federal Regulatory Guide.

[15]  Xiaohui Li,et al.  Real-Time Trajectory Planning for Autonomous Urban Driving: Framework, Algorithms, and Verifications , 2016, IEEE/ASME Transactions on Mechatronics.

[16]  David J. Cole,et al.  Predictive and linear quadratic methods for potential application to modelling driver steering control , 2006 .

[17]  Charles C. MacAdam,et al.  An Optimal Preview Control for Linear Systems , 1980 .

[18]  Tulga Ersal,et al.  A nonlinear model predictive control formulation for obstacle avoidance in high-speed autonomous ground vehicles in unstructured environments , 2018 .

[19]  Hans B. Pacejka,et al.  Tire and Vehicle Dynamics , 1982 .

[20]  Michel Basset,et al.  Coupled longitudinal and lateral control strategy improving lateral stability for autonomous vehicle , 2012, 2012 American Control Conference (ACC).

[21]  Guilherme V. Raffo,et al.  A Predictive Controller for Autonomous Vehicle Path Tracking , 2009, IEEE Transactions on Intelligent Transportation Systems.

[22]  David J. Cole,et al.  Measurement and mathematical model of a driver's intermittent compensatory steering control , 2015 .

[23]  Xiaolin Song,et al.  Simulation research on emergency path planning of an active collision avoidance system combined with longitudinal control for an autonomous vehicle , 2016 .

[24]  Jonas Sjöberg,et al.  Receding horizon maneuver generation for automated highway driving , 2015 .

[25]  A. El Hajjaji,et al.  Vehicle dynamics and road curvature estimation for lane departure warning system using robust fuzzy observers: experimental validation , 2015 .

[26]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[27]  Marko Bacic,et al.  Model predictive control , 2003 .

[28]  Mathias R Lidberg,et al.  Automated driving and autonomous functions on road vehicles , 2015 .

[29]  Keqiang Li,et al.  An adaptive fuzzy-sliding lateral control strategy of automated vehicles based on vision navigation , 2013 .

[30]  Yi Tinghua.  On GPS Observation Errors with ANC Principles and Wavelet Denoise Method , 2006 .

[31]  Thomas B. Sheridan,et al.  Three Models of Preview Control , 1966 .

[32]  Rajesh Rajamani,et al.  Vehicle dynamics and control , 2005 .

[33]  Philippe Chevrel,et al.  Optimal Control with Preview for Lateral Steering of a Passenger Car: Design and Test on a Driving Simulator , 2012 .

[34]  Jinsong Zhou,et al.  Boundary conditions of active steering control of independent rotating wheelset based on hub motor and wheel rotating speed difference feedback , 2018 .

[35]  Timothy Gordon,et al.  Anticipatory speed control model applied to intersection left turns , 2012 .

[36]  Carlos Bordons Alba,et al.  Model Predictive Control , 2012 .

[37]  Thomas Sattel,et al.  From robotics to automotive: Lane-keeping and collision avoidance based on elastic bands , 2008 .

[38]  Shan Bao,et al.  An optimal model-based trajectory following architecture synthesising the lateral adaptive preview strategy and longitudinal velocity planning for highly automated vehicle , 2017 .

[39]  Lie Guo,et al.  Trajectory planning and tracking control for autonomous lane change maneuver based on the cooperative vehicle infrastructure system , 2015, Expert Syst. Appl..

[40]  Julius Ziegler,et al.  Optimal trajectories for time-critical street scenarios using discretized terminal manifolds , 2012, Int. J. Robotics Res..

[41]  Francesco Borrelli,et al.  Driver models for personalised driving assistance , 2015 .

[42]  David J. Cole,et al.  Vehicle trajectory linearisation to enable efficient optimisation of the constant speed racing line , 2012 .

[43]  Myoungho Sunwoo,et al.  A probabilistic optimization approach for motion planning of autonomous vehicles , 2018 .

[44]  Fawzi Nashashibi,et al.  Multivehicle Cooperative Local Mapping: A Methodology Based on Occupancy Grid Map Merging , 2014, IEEE Transactions on Intelligent Transportation Systems.

[45]  Feng You,et al.  Study on Self-Tuning Tyre Friction Control for Developing Main-Servo Loop Integrated Chassis Control System , 2017, IEEE Access.

[46]  Hassan Salarieh,et al.  Path-following in model predictive rollover prevention using front steering and braking , 2017 .