- Decision-tree based maneuver decision
- Overtake decision based on object types
- Compare with ego vehicle’s predicted motion with surroundings’ predicted motion
- Sampling and optimization-based trajectory planning
- Sampling-based lateral candidate generation
- Optimization-based longitudinal motion optimization for each lateral candidates