Efficient Re-planning for Robotic Cars