Кибернетика, автоматика, протоколы

Здравствуйте. Прошу подсказать оптимальный алгоритм для решения задачи формирования выходного сигнала со сдвигом фазы относительно входного в диапазоне -Pi/4 ...0...+Pi/4. На вход МК поступает заранее известная мне кодовая комбинация. Код периодический. Например: 5353.... Частота кода все время изменяется в диапазоне от 20 Гц до 40 кГц. На выходе МК надо сформировать этот же код но сдвинутый относительно входного по фазе как в позднюю так и в раннюю сторону. Величина сдвига в + или - задается оператором. Не могу выбрать алгоритм со сдвигом фазы выходного сигнала относительно входного в раннюю сторону, приходит мысль связанная только с линейным предсказанием. Если есть более красивое решение, прошу подсказать статью, книгу. Требования по точности пока уточняю, камень будет из семейства STM32.