AStar: Correctly calculate distance to start node when moving diagonally