Improving Pathfinding Quality With New Algorithm

send the navmap by turning on debug visualization