Upsampled A* heuristic function by 10 times instead of 2. Caused increased speed by 25%, dont know why.