Added some primitive pathfinding