c++ a_star完成

Signed-off-by: ElmerNing <ffxhina@gmail.com>