Update Grid_router.cc