А еще можно просто алгоритмом фронта волны
Тогда вообще задача будет примитивной и никакие стеки нахрен не нужны будут.