fixed Astar
Cost is corrected
Merge branch 'dban' of https://github.com/hempywh/maze_search
Merge branch 'master' of https://github.com/hempywh/maze_search