- Sampling based Trajectory Planning in Off-Road
- Sampling-based lateral candidate generation incorporating terrain geometry
- Traversability estimation for each candidate considering ground surface 
- Optimal trajectory selection based on candidate evaluation