Self-Drive IGVC Simulation Environment

Working on making the IGVC simulation environment, currently a base in roads:

<img width="967" height="547" alt="Image" src="https://github.com/user-attachments/assets/45450a85-f156-4fa5-89bd-54dda9203849" />