Добавлено смещение в алгоритм. Поправил косячки.