Finished Car pathfinding

I fixed everything wrong, i believe. We still need two more test cases, added and tested, so that everyone will have something to present, but I am busy right up until the meeting tonight.