Cleaned up code, added move forward if the robot is still far from ahead car in parking space.