more pathfinding stuff

Still not working like it should.