Fixed a null reference bug
Removed the diagonal component from the path because it made the car behave weird