3D Navigation: Pathfinding for Flying and Underwater AI