Contingency Planning And Obstacle Anticipation For Autonomous Driving