Added basic pathfinding