Find shortest path with blocked nodes