Astar didn't found the shortest path, due to rounding errors.
Merge pull request #1 from PedersenThomas/master

Astar didn't found the shortest path, due to rounding errors.