Леонид, все путем.
Алгоритм очень даже
Переделывать не надо