A_star_algo_impl