Update Grid_router.h