The pathfinding should finaly be working, now to figure out what to do with it.