TODO.md

• Documentation and refactoring
• Lane changing AI
  • Improve lane cost function
    • Customisable?
  • Filter lane changes when vehicles are too close, or lane ends
  • Allow re-routing if the vehicle gets stuck
  • Use astar? Use fast_paths crate?
• Better gap acceptance
  • Important for roundabouts
• Smoother merging