Combining Lattice-Based Planning and Path Optimization in Autonomous Heavy Duty Vehicle Applications

Lattice-based motion planners are an established method to generate feasible motions for car-like vehicles. However, the solution paths can only reach a discretized approximation of the intended goal pose. Moreover, they can be optimal only with respect to the actions available to the planner, which can result in paths with excessive steering. These drawbacks have a negative impact when used in real systems. In this paper we address both drawbacks by integrating a steering method into a state-of-the-art lattice-based motion planner. Un- like previous approaches, in which path optimization happens in an a posteriori step after the planner has found a solution, we propose an interleaved execution of path planning and path optimization. The proposed approach can run in real-time and is implemented in a full-size autonomous truck, and we show experimentally that it is able to greatly improve the quality of the solutions provided by a lattice planner.

[1]  Jari Saarinen,et al.  Fast, continuous state path smoothing to improve navigation accuracy , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Matthias Althoff,et al.  Verifying the safety of lane change maneuvers of self-driving vehicles based on formalized traffic rules , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[3]  Alois Knoll,et al.  Motion planning under perception and control uncertainties with Space Exploration Guided Heuristic Search , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[4]  Maxim Likhachev,et al.  D*lite , 2002, AAAI/IAAI.

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

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

[7]  Bo Wahlberg,et al.  Spatial Model Predictive Control for Smooth and Accurate Steering of an Autonomous Truck , 2017, IEEE Transactions on Intelligent Vehicles.

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

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

[10]  Thomas Schamm,et al.  Hybrid curvature steer: A novel extend function for sampling-based nonholonomic motion planning in tight environments , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).

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

[12]  Sven Koenig,et al.  A lattice-based approach to multi-robot motion planning for non-holonomic vehicles , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Marcello Cirillo,et al.  From videogames to autonomous trucks: A new algorithm for lattice-based motion planning , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[14]  Philip Ross,et al.  Robot, you can drive my car , 2014, IEEE Spectrum.

[15]  Sanjiv Singh,et al.  The DARPA Urban Challenge: Autonomous Vehicles in City Traffic, George Air Force Base, Victorville, California, USA , 2009, The DARPA Urban Challenge.

[16]  Nathan R. Sturtevant,et al.  TBA*: Time-Bounded A* , 2009, IJCAI.

[17]  Ross A. Knepper,et al.  Differentially constrained mobile robot motion planning in state lattices , 2009 .

[18]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[19]  D. Dolgov.  Practical Search Techniques in Path Planning for Autonomous Driving , 2008 .

[20]  Bo Wahlberg,et al.  Trajectory Generation using Sharpness Continuous Dubins-like Paths with Applications in Control of Heavy-Duty Vehicles , 2018, 2018 European Control Conference (ECC).