[TEST] Added more pathfinding tests