true distance calc for path finding