Pathfinding Algorithm - Ontify