Data-Driven State-Increment Statistical Model and Its Application in Autonomous Driving

The aim of trajectory planning is to generate a feasible, collision-free trajectory to guide an autonomous vehicle from the initial state to the goal state safely. However, it is difficult to guarantee that the trajectory is feasible for the vehicle and the real path of the vehicle is collision-free when the vehicle follows the trajectory. In this paper, a state-increment statistical model (SISM) is proposed to describe the kinodynamic constraints of a vehicle by modeling the controller, the actuator, and the vehicle model jointly. The SISM consists of Gaussian distributions of lateral error increments in all state subspaces which are composed of the curvature radius, the velocity, and the lateral error. It is a data-driven modeling approach that can improve the SISM via increasing the number of samples of the increment-state, which is composed of the state and its corresponding increment of the lateral error. According to the SISM, the experience cost functions are designed to evaluate the trajectories for searching the best one with the lowest cost, and the real path can be predicted directly according to the planned trajectory and the vehicle state. The predicted path can be utilized effectually to evaluate the safety of the vehicle motion.

[1]  Nanning Zheng,et al.  Efficient Sampling-Based Motion Planning for On-Road Autonomous Driving , 2015, IEEE Transactions on Intelligent Transportation Systems.

[2]  John M. Dolan,et al.  Toward human-like motion planning in urban environments , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

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

[4]  Matthew Greytak,et al.  Planning to learn: Integrating model learning into a trajectory planner for mobile robots , 2009, 2009 International Conference on Information and Automation.

[5]  Emilio Frazzoli,et al.  Sampling-based optimal motion planning for non-holonomic dynamical systems , 2013, 2013 IEEE International Conference on Robotics and Automation.

[6]  Daniel D. Lee,et al.  Little Ben: The Ben Franklin Racing Team's entry in the 2007 DARPA Urban Challenge , 2008, J. Field Robotics.

[7]  Julius Ziegler,et al.  Team AnnieWAY's autonomous system for the 2007 DARPA Urban Challenge , 2008, J. Field Robotics.

[8]  Mark E. Campbell,et al.  Multi-step prediction of nonlinear Gaussian Process dynamics models with adaptive Gaussian mixtures , 2015, Int. J. Robotics Res..

[9]  Maxim Likhachev,et al.  Motion planning in urban environments , 2008 .

[10]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

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

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

[13]  Ephrahim Garcia,et al.  Team Cornell's Skynet: Robust perception and planning in an urban environment , 2008, J. Field Robotics.

[14]  Jianru Xue,et al.  A constrained VFH algorithm for motion planning of autonomous vehicles , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[15]  Hongbin Zha,et al.  Learning lane change trajectories from on-road driving data , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[16]  Rüdiger Dillmann,et al.  Learning context sensitive behavior models from observations for predicting traffic situations , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[17]  Alonzo Kelly,et al.  Reactive Nonholonomic Trajectory Generation via Parametric Optimal Control , 2003, Int. J. Robotics Res..

[18]  Kyongsu Yi,et al.  Probabilistic and Holistic Prediction of Vehicle States Using Sensor Fusion for Application to Integrated Vehicle Safety Systems , 2014, IEEE Transactions on Intelligent Transportation Systems.

[19]  Luke Fletcher,et al.  A perception-driven autonomous urban vehicle , 2008 .

[20]  Peter King,et al.  Odin: Team VictorTango's entry in the DARPA Urban Challenge , 2008, J. Field Robotics.

[21]  Ross A. Knepper,et al.  Constrained Optimization Path Following of Wheeled Robots in Natural Terrain , 2006, ISER.

[22]  A. Kelly,et al.  TRAJECTORY GENERATION FOR CAR-LIKE ROBOTS USING CUBIC CURVATURE POLYNOMIALS , 2001 .

[23]  Sebastian Thrun,et al.  Junior: The Stanford entry in the Urban Challenge , 2008, J. Field Robotics.

[24]  Julius Ziegler,et al.  Optimal trajectory generation for dynamic street scenarios in a Frenét Frame , 2010, 2010 IEEE International Conference on Robotics and Automation.