Added pedro and pathfinding back in