FindPath implementation is working