added some more pathfinding code
added more pathfinding code