Safe Driving in Occluded Environments