added pathfinding (to diego)