Intention Aware Motion Planning with Model Predictive Control in Highway Merge Scenario 2019-01-1402
Human drivers navigate by continuously predicting the intent of road users and interacting with them. For safe autonomous driving, research about predicting future trajectory of vehicles and motion planning based on these predictions has drawn attention in recent years. Most of these studies, however, did not take into account driver’s intentions or any interdependence with other vehicles. In order to drive safely in real complex driving situations, it is essential to plan a path based on other driver’s intentions and simultaneously to estimate the intentions of other road user with different characteristics as human drivers do. We aim to tackle the above challenges on highway merge scenario where the intention of other road users should be understood. In this study, we propose an intention aware motion planning method using model predictive control without any vehicle-to-vehicle (V2V) or vehicle-to-infrastructure (V2I) communications. The key idea is to directly model the intention and characteristics of other driver as a state-space model and to estimate those unobservable states through observable vehicle states (e.g. lateral offset, velocity and acceleration). The model predictive controller generates an optimized trajectory for merging in terms of safety, efficiency and comfort with directly reflecting the estimated intention of the road users. In order to verify the proposed framework, the complex highway merging scenario is implemented where various road users with different intention and characteristic exist by using IDM (Intelligent Driver Model) and MOBIL (Minimizing Overall Braking Induced by Lane change) model.