Фазовый сдвиг, Алгоритм Опции

[repairDV]

Задача , вероятно, довольно простая. Но, увы, для меня пока - довольно сложная.
Имеется самодельное устройство - асинхронный электропривод. Функция регулирования частоты вращения работает стабильно. Имеется ШИМ-модуляция , частотой 2 кГц. (Кстати, замечено свойство: при частотах ниже 34 гц в режиме холостого хода ток выше, чем в режиме под нагрузкой. Но речь не об этом.) При проверке осциллографом угла сдвига фаз между током и напряжением совершенно отчётливо видно, что в режиме Х.Х. электрический угол равен тому значению, который указан на шильдовой табличке электродвигателя. Когда ты тормозишь электродвигатель, то угол между током и напряжением на экране осциллографа смещается влево таким образом, что на частоте 50 гц(максимальной) он становится равным нулю. Т.е., очевидно, что есть возможность регулирования момента(или мощности) электродвигателя путём изменения скважности ШИМ. Но - это вкратце задача, к теме не относящаяся. Тема такова, что АЦП микроконтроллера имеет свойство нестабильности. Я использую пока устаревший микроконтроллер XC56F803, как модель(XC - это опытный образец). Микроконтроллер имеет в системном ассемблере команды DSP. Т.е., это - DSP. Моя задача - определить угол сдвига между напряжением и током в фазах электродвигателя. Простым путём, т.е. определением момента перехода синусоиды тока через нулевое значение - не получается. Вернее, получается, т.е. видно путём контроля за состоянием регистров АЦП микроконтроллера в реальном времени, что АЦП этот момент "видит". Но, увы, АЦПшка настолько нестабильная, что применять её для регулирования не представляется возможным - если идти по прямому пути.
Но, вероятно, есть способы определения угла сдвига фаз путём расчёта функций DSP - собственно, для чего этот микроконтроллер и предназначен.
Т.е., конкретный вопрос: методы определения угла сдвига фаз в цифровых фильтрах. Кстати, аппаратный фильтр обратной связи по току в той схеме, которую использую я, имеет свойство "наслаивания" гармоник, кратных 50 гц, т.е картина на частотах, ниже 25 гц не похожа на синусоиду, при контроле осциллографом. Да, это, скорее всего, общая беда всех аналоговых фильтров - гармоники.
В общем-то, можно было бы сделать электропривод и в простом варианте, без регулирования момента, но - привычка всё время усложнять себе задачу.

[fontp]

С шумами можно разобраться увеличивая время интегрирования (число периодов), поскольку это узкополосный фильтр с полосой dF~ 1/T, ограничивается только стабильностью частоты.

Гармоники, если они несильные (если считать, что есть основной тон и слабые кратные гармоники) тоже проблем не возникнет, поскольку их вклад в интеграл квадратичен по амплитуде (биения с основным тоном обнуляются при интегрированию по периоду). Будет примерно cos фазы основной гармоники