Interactive Joint Planning for Autonomous Vehicles
In highly interactive driving scenarios, the actions of one agent greatly influences those of its neighbors. Planning safe motions for autonomous vehicles in such interactive environments, therefore, requires reasoning about the impact of the ego's intended motion plan on nearby agents' behavior. Deep-learning-based models have recently achieved great success in trajectory prediction and many models in the literature allow for ego-conditioned prediction. However, leveraging ego-conditioned prediction remains challenging in downstream planning due to the complex nature of neural networks, limiting the planner structure to simple ones, e.g., sampling-based planner. Despite their ability to generate fine-grained high-quality motion plans, it is difficult for gradient-based planning algorithms, such as model predictive control (MPC), to leverage ego-conditioned prediction due to their iterative nature and need for gradient. We present Interactive Joint Planning (IJP) that bridges MPC with learned prediction models in a computationally scalable manner to provide us the best of both the worlds. In particular, IJP jointly optimizes over the behavior of the ego and the surrounding agents and leverages deep-learned prediction models as prediction priors that the join trajectory optimization tries to stay close to. Furthermore, by leveraging homotopy classes, our joint optimizer searches over diverse motion plans to avoid getting stuck at local minima. Closed-loop simulation result shows that IJP significantly outperforms the baselines that are either without joint optimization or running sampling-based planning.
Code (0)
등록된 구현이 없습니다.
Tasks
Autonomous VehiclesModel Predictive ControlMotion PlanningPredictionTrajectory PredictionSimilar Papers 제목 키워드 기반
Automated Lane Change via Adaptive Interactive MPC: Human-in-the-Loop Experiments
This article presents a new optimal control-based interactive motion planning algorithm for an autonomous vehicle interacting with a human-driven vehicle. The ego vehicle solves a joint optimization problem for its motio…
Autonomous VehiclesModel Predictive ControlMotion PlanningLarge Scale Interactive Motion Forecasting for Autonomous Driving : The Waymo Open Motion Dataset
As autonomous driving systems mature, motion forecasting has received increasing attention as a critical requirement for planning. Of particular importance are interactive situations such as merges, unprotected turns, et…
Autonomous DrivingMotion ForecastingMotion PlanningLarge Scale Interactive Motion Forecasting for Autonomous Driving: The Waymo Open Motion Dataset
As autonomous driving systems mature, motion forecasting has received increasing attention as a critical requirement for planning. Of particular importance are interactive situations such as merges, unprotected turns…
Autonomous DrivingMotion ForecastingMotion PlanningSearch-Based Autonomous Vehicle Motion Planning Using Game Theory
In this paper, we propose a search-based interactive motion planning scheme for autonomous vehicles (AVs), using a game-theoretic approach. In contrast to traditional search-based approaches, the newly developed approach…
Autonomous VehiclesMotion PlanningA Cooperation-Aware Lane Change Method for Autonomous Vehicles
Lane change for autonomous vehicles (AVs) is an important but challenging task in complex dynamic traffic environments. Due to difficulties in guarantee safety as well as a high efficiency, AVs are inclined to choose rel…
Autonomous VehiclesModel Predictive ControlMotion PlanningTrajectory Prediction