Update grid_routing.cc