Increase A* pathfinder accuracy by switching back to distance squared