Update my_a_star_router.cc