После замены , , передаточная функция корректирующего устройства примет вид:

Найдем разностное уравнение в реальном масштабе времени:

По уравнению (57) реализуем программу коррекции на языке Ассемблер.

;Расчет разностного уравнения

;

; – входной сигнал

; – выходной сигнал

i_port EQU 11h; номер порта для чтения

o_port EQU 12h; номер порта для записи

А1 EQU 21;

A2 EQU -19;

B1 EQU 67,2;

B2 EQU -65,2;

1, 2 DB 0; выделение памяти под

;переменные (k-1), (k-2)

1, 2, DB 0; выделение памяти под

; переменные (k-1), (k-2)

;вычисляем значение выражения

(k)=A1*1+A2*2+B1*1+B2*2

start: ;метка начала цикла коррекции

in al, I_port; чтение данных из порта

mov al,A1; вычисление слагаемого А1*1

mov bl, al; сохранение результата в bl

; в результате имеем А1*1 в регистре bl

mov al, 2; вычисление

mul al, A2; слагаемого А2*2

add bl, al; вычисление из предыдущего результата

; в результате имеем А1*1+А2*2 в регистре bl

mov al, 1; вычисление

mul al, B1; слагаемого B1*1

add bl, al; вычисление из предыдущего результата

mov al, 2; вычисление

mul al, B2; слагаемого B2*2

add bl, al; вычисление из предыдущего результата

; в регистре bl имеем результат вычисления всего выражения

mov 2, 1; для следующего такта

mov 1, bl;

mov 2, 1;

mov 1, ;

out o_port, bl; вывод управляющего сигнала из bl

jmp start; зацикливание на начало программы

1

u_k-1=0; u_k-2=0;

_k-1=0; _k-2=0;

2

3

4

u_k-2=u_k-1; u_k-1=u_k;

_k-2=_k-1; _k-1=_k;

5

6

7

Рисунок 11 - Блок – схема алгоритма коррекции

Отличительная особенность аппаратных КУ заключается в их способности убирать возмущающие воздействия или помехи, используются как фильтр. Программный метод коррекции проще, так как не требует дополнительных затрат, но страдает качество сигнала.