got pathfinding working using an existing AStar implementation