forked from: forked from: A* Path Finding

...
@author Motoki Matsumoto