First pass at pathfinding