Optimized and sped up pathfinding.
9x9 to 11x11 grid.