Алгоритм верный, какие проблемы с переводом на язык программирования?