Model Based Trajectory Planning for Highly Automated Road Vehicles

Abstract The aim of this paper is to present a local trajectory planning method based on nonlinear optimization that is able to generate a dynamically feasible, comfortable and customizable trajectory for highly automated road vehicles. The presented algorithm is able to consider the nonholonomic dynamics of wheeled vehicles and ensures the dynamical feasibility of the planned trajectory by the model-based prediction of the vehicle’s motion. The behavior of the vehicle is simulated with closed loop trajectory tracking control which allows to generate not only the trajectory of the vehicle but also the reference signal inputs for the controllers. The direct planning of the reference signals enables the vehicle to run exactly on the generated trajectory and eliminates the delays related to the inertia of the system.

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

[2]  Sterling J. Anderson,et al.  An optimal-control-based framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios , 2010 .

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

[4]  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..

[5]  H Suzuki,et al.  Research trends on riding comfort evaluation in Japan , 1998 .

[6]  JiYe Zhang,et al.  Trajectory planning and yaw rate tracking control for lane changing of intelligent vehicle on curved road , 2011 .

[7]  D. Marquardt.  An Algorithm for Least-Squares Estimation of Nonlinear Parameters , 1963 .

[8]  Alonzo Kelly,et al.  Optimal Rough Terrain Trajectory Generation for Wheeled Mobile Robots , 2007, Int. J. Robotics Res..

[9]  M. J. D. Powell,et al.  A fast algorithm for nonlinearly constrained optimization calculations , 1978 .

[10]  Jorge Nocedal,et al.  A trust region method based on interior point techniques for nonlinear programming , 2000, Math. Program..

[11]  Dirk Haehnel,et al.  Junior: The Stanford entry in the Urban Challenge , 2008 .

[12]  Martin Buss,et al.  On-line Trajectory Generation for Safe and Optimal Vehicle Motion Planning , 2012, AMS.