Working on pathfinding, WIP.