Gave pathfinding to fsm