1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
| ;Разностное уравнение Yn = Xn - 0.85Xn-1 + Xn-2 - 0,85Xn-3 – Yn-1
;Определение символических имён операндов
B6: .EQU 96h ;линия P1.6 для вывода импульса
;запуска АЦП
PB: .EQU 7001h ;порт PB РУ55
PA: .EQU 7002h ;порт PA РУ55
RGRU: .EQU 7000h ;регистр управляющего слова РУ55
SRU: .EQU 02h ;управляющее слово для настройки
;портов РУ55
TMOD: .EQU 89h ;регистр управления режимами
;таймеров-счётчиков
STMOD: .EQU 02h ;управляющее слово для настройки
;таймера-счётчика
TH0: .EQU 8Ch ;старший байт Т/С0
STH0: .EQU 0Eh ;управляющее слово для задания
;частоты переполнения T/C0
TR0: .EQU 8Ch ;управляющий бит пуска T/C0
IE: .EQU A8h ;регистр разрешения прерываний
SIE: .EQU 83h ;слово разрешения прерываний
;от T/C0 и входа INT0
B: .EQU F0h ;регистр В
K: .EQU D9h ;коэффициент разностного уравнения
KM: .EQU 36h ;коэффициент масштабирования
X: .EQU 30h ;ячейка хранения отсчёта Xn
X1: .EQU 31h ;ячейка хранения отсчёта Xn-1
X2: .EQU 32h ;ячейка хранения отсчёта Xn-2
X3: .EQU 33h ;ячейка хранения отсчёта Xn-3
Y: .EQU 40h ;ячейка хранения отсчёта Yn
Y1: .EQU 41h ;ячейка хранения отсчёта Yn-1
PR1: .EQU 50h ;ячейка хранения произведения PR1n
PR2: .EQU 51h ;ячейка хранения произведения PR2n
PR3: .EQU 52h ;ячейка хранения произведения PR3n
.FILLCHAR 00h ;записать в пропусках
;между секциями нули
;Инициализация по сигналу RST
S0: .SECTION
.ORG 0000h
LJMP INIT ;переход к программе
;инициализации
S1: SECTION
.ORG 00A0h
INIT: MOV TMOD, #STMOD ;настройка режима Т/С0
MOV TH0, #STH0 ;задание частоты дискре-
;тизации
SETB TR0 ;пуск Т/С0
MOV A, #SRU ;настройка порта PB РУ55
MOV DPTR, #RGRU ;на ввод, порта PA РУ55 -
MOVX @DPTR, A ;на вывод
MOV IE, #SIE ;разрешение прерываний
;от Т/С0 и входа INT0
STOP: SJMP STOP ;остановка программы
;Формирование импульса пуска АЦП по внутреннему прерыва-
;нию от Т/С0
S2: .SECTION
.ORG 000Bh
LJMP START ;переход к программе
;формирования импульса
;пуска АЦП
S3: .SECTION
.ORG 00D0h
START: CLR B6 ;сброс бита Р1.6
SETB B6 ;установка бита Р1.6
RETI ;возврат из подпрограм-
;мы обработки прерыва-
;ния
;Вычисление выходного отсчёта по сигналу внешнего прерыва-
;ния от входа INT0, рабочий цикл фильтра
S4: .SECTION
.ORG 0003h
LJMP XYOUT ;переход к программе
;рабочего цикла фильтра
S5: .SECTION
.ORG 0100h
XYOUT: MOV DPTR, #PB ;ввод отсчёта Xn из АЦП
MOVX A, @DPTR ;через порт РB РУ55
;программный модуль масштабирования:
;вычисление произведения Xn := KмXn
;входной отсчёт - в аккумуляторе, масштаби-
;рованный отсчёт записать в ячейку ОЗУ
RLC A ;анализ знака Xn
JC M1 ;переход к программе ум-
;ножения отрицательного
;отсчёта Xn на Kм
RRC A ;восстановление положи-
;тельного отсчёта Xn
;в аккумуляторе
MOV B, #KM ;вычисление произведе-
MUL AB ;ния KмXn
MOV X, B ;запоминание масштаби-
;рованного отсчёта Xn
;в памяти
SJMP M2 ;переход к продолжению
M1: RRC A ;восстановление отрица-
;тельного отсчёта Xn
;в аккумуляторе
CPL A ;получение положительно-
INC A ;го отсчёта Xn (смена зна-
;ка)
MOV B, #KM ;вычисление произведе-
MUL AB ;ния KмXn и пересылка
MOV A, B ;в аккумулятор
CPL A ;получение отрицательно-
INC A ;го произведения KмXn
;(смена знака)
MOV X, A ;запоминание масштаби-
;рованного отсчёта Xn
;в памяти
;программный модуль вычисления
;произведения PR1n := KXn-1
;Xn-1 хранится в ячейке ОЗУ с адресом X1
;PR1n записать в ячейку ОЗУ с адресом PR1
M2: MOV A, X1 ;копирование Xn-1 в аккуму-
RLC A ;лятор и анализ знака
JC M3 ;переход к программе ум-
;ножения отрицательного
;отсчёта Xn-1 на K
RRC A ;восстановление положи-
;тельного отсчёта Xn-1
;в аккумуляторе
MOV B, #K ;вычисление произведе-
MUL AB ;ния KXn-1
MOV PR1, B ;запоминание KXn-1
;в памяти
SJMP M4 ;переход к продолжению
M3: RRC A ;восстановление отрица-
;тельного отсчёта Xn-1
;в аккумуляторе
CPL A ;получение положительно-
INC A ;го отсчёта Xn-1 (смена зна-
;ка)
MOV B, #K ;вычисление произведе-
MUL AB ;ния KXn-1 и пересылка
MOV A, B ;в аккумулятор
CPL A ;получение отрицательно-
INC A ;го произведения KXn-1
;(смена знака)
MOV PR1, A ;запоминание KXn-1 в па-
;мяти
;программный модуль вычисления
;произведения PR2n := KXn-3
;Xn-3 хранится в ячейке ОЗУ с адресом X3
;PR2n записать в ячейку ОЗУ с адресом PR2
M4: MOV A, X3 ;копирование Xn-3 в акку-
RLC A ;мулятор и анализ знака
JC M5 ;переход к программе ум-
;ножения отрицательного
;отсчёта Xn-3 на K
RRC A ;восстановление положи-
;тельного отсчёта Xn-3
;в аккумуляторе
MOV B, #K ;вычисление произведе-
MUL AB ;ния KXn-3
MOV PR2, B ;запоминание KXn-3
;в памяти
SJMP M6 ;переход к продолжению
M5: RRC A ;восстановление отрица-
;тельного отсчёта Xn-3
;в аккумуляторе
CPL A ;получение положительно-
INC A ;го отсчёта Xn-3 (смена
;знака)
MOV B, #K ;вычисление произведе-
MUL AB ;ния KXn-3 и пересылка
MOV A, B ;в аккумулятор
CPL A ;получение отрицательно-
INC A ;го произведения KXn-3
;(смена знака)
MOV PR2, A ;запоминание KXn-3 в па-
;мяти
;программный модуль вычисления выходного
;отсчёта Yn = xn - PR1n + Xn-2 - PR2n - Yn-1, слагаемые
;хранятся в ячейках ОЗУ, результат записать
;в ячейку ОЗУ и вывести на ЦАП
M6: MOV A, X ;вычисление отсчёта Yn
CLR C ;
SUBB A, PR1 ;и сохранение в памяти
ADD A, X2 ;
CLR C ;
SUBB A, PR2 ;
SUBB A, Y1 ;
MOV Y, A ;
ADD A, #80h ;получение смещённого
;кода Yn для ЦАП
MOV DPTR, #PA ;вывод смещённого кода
MOVX @DPTR, A ;Yn через порт РA РУ55
;программный модуль сдвига отсчётов
;в памяти, подготовка следующего рабочего
;цикла
MOV X3, X2 ;
MOV X2, X1 ;
MOV X1, X ;
MOV Y1, Y ;
RETI ;возврат из подпрограммы
;обслуживания прерыва-
;по входу INT0
.END |
(
Сообщение от Pavel1169
. Я и не предлагал в отладчике искать ошибки. Предлагалось ошибку найти в алгоритме Вашей программы. При проверке результатов в контрольных точках вычислений. Скажем, умножили на 0.85 - проверили. Разделили одно на другое - проверили. Ну, и т.д.
