Started work on some AStar pathfinding