pathfinding working, needs node tweaking