add A* algorithm
Merge pull request #2 from jo32/master

add A* algorithm