WIP on pathfinding still