Car Passing Fixes

A lot of fixes in car passing, sort of works, one needs to implement
checking the opposite direction for avoiding collisions