pathfinding sort of almost working