Added dijakstra' algorthim heuristic (returns 0).
Bugfix for a bug where pythagorean theorem was being totally botched in StraightLineAStarHeuristic.