Update p_astar_wrapper.cpp