TR2016-038

Joint Decision Making and Motion Planning for Road Vehicles Using Particle Filtering


    •  Berntorp, K.; Di Cairano, S., "Joint Decision Making and Motion Planning for Road Vehicles Using Particle Filtering", IFAC Symposium Advances in Automotive Control, DOI: 10.1016/j.ifacol.2016.08.027, June 2016, vol. 49, pp. 175-181.
      BibTeX Download PDF
      • @inproceedings{Berntorp2016jun,
      • author = {Berntorp, K. and {Di Cairano}, S.},
      • title = {Joint Decision Making and Motion Planning for Road Vehicles Using Particle Filtering},
      • booktitle = {IFAC Symposium Advances in Automotive Control},
      • year = 2016,
      • volume = 49,
      • number = 11,
      • pages = {175--181},
      • month = jun,
      • doi = {10.1016/j.ifacol.2016.08.027},
      • url = {http://www.merl.com/publications/TR2016-038}
      • }
  • MERL Contact:
  • Research Area:

    Mechatronics


This paper describes a probabilistic framework for real-time, joint decision making and trajectory generation of road vehicles. The selection of desired lane and state profile is posed as a stochastic nonlinear estimation problem. The nonlinear estimator is integrated with a sampling-based motion planner that computes candidate paths and corresponding state trajectories, while accounting for obstacle motion. The motion planner is implemented in receding horizon and repeatedly replans, based on stored candidate trajectories. A simulated autonomous highway-driving example illustrate show vehicle dynamics is naturally handled in the framework. The results show that the framework is capable of making effective online decisions and computing safe trajectories.