Simple pathfinding of a small 2D graph