Astar start.

Stucked in problem01  Orz.