[TanaTiX]

алгоритм тяжелый получился

При желании можно и без рекурсии одним проходом. Допиливать наверняка есть что. Но по сути будет тоже самое. В плане производительности нужно иметь хотя бы альтернативу для сравнения.