Update grid_routing.h