Work on own pathfinding