Pioneering SE(2)-Equivariant Trajectory Planning for Automated Driving
Planning the trajectory of the controlled ego vehicle is a key challenge in automated driving. As for human drivers, predicting the motions of surrounding vehicles is important to plan the own actions. Recent motion prediction methods utilize equivariant neural networks to exploit geometric symmetries in the scene. However, no existing method combines motion prediction and trajectory planning in a joint step while guaranteeing equivariance under roto-translations of the input space. We address this gap by proposing a lightweight equivariant planning model that generates multi-modal joint predictions for all vehicles and selects one mode as the ego plan. The equivariant network design improves sample efficiency, guarantees output stability, and reduces model parameters. We further propose equivariant route attraction to guide the ego vehicle along a high-level route provided by an off-the-shelf GPS navigation system. This module creates a momentum from embedded vehicle positions toward the route in latent space while keeping the equivariance property. Route attraction enables goal-oriented behavior without forcing the vehicle to stick to the exact route. We conduct experiments on the challenging nuScenes dataset to investigate the capability of our planner. The results show that the planned trajectory is stable under roto-translations of the input scene which demonstrates the equivariance of our model. Despite using only a small split of the dataset for training, our method improves L2 distance at 3 s by 20.6 % and surpasses the state of the art.
Code (0)
등록된 구현이 없습니다.
Tasks
motion predictionTrajectory PlanningMethods 이 논문이 사용한 방법론
Similar Papers 제목 키워드 기반
An enhanced motion planning approach by integrating driving heterogeneity and long-term trajectory prediction for automated driving systems
Navigating automated driving systems (ADSs) through complex driving environments is difficult. Predicting the driving behavior of surrounding human-driven vehicles (HDVs) is a critical component of an ADS. This paper pro…
Motion PlanningTrajectory PredictionReinforced Imitative Trajectory Planning for Urban Automated Driving
Reinforcement learning (RL) faces challenges in trajectory planning for urban automated driving due to the poor convergence of RL and the difficulty in designing reward functions. The convergence problem is alleviated by…
Imitation Learningreinforcement-learningReinforcement LearningReinforcement Learning (RL)+1Multistage Stochastic Model Predictive Control for Urban Automated Driving
Trajectory planning in urban automated driving is challenging because of the high uncertainty resulting from the unknown future motion of other traffic participants. Robust approaches guarantee safety, but tend to result…
Model Predictive ControlMotion PlanningTrajectory PlanningTwo Tasks, One Goal: Uniting Motion and Planning for Excellent End To End Autonomous Driving Performance
End-to-end autonomous driving has made impressive progress in recent years. Former end-to-end autonomous driving approaches often decouple planning and motion tasks, treating them as separate modules. This separation ove…
Autonomous DrivingBench2DriveA Rapid Iterative Trajectory Planning Method for Automated Parking through Differential Flatness
As autonomous driving continues to advance, automated parking is becoming increasingly essential. However, significant challenges arise when implementing path velocity decomposition (PVD) trajectory planning for automate…
Collision AvoidanceTrajectory PlanningAutonomous Driving