Прерывания по совпадению, СТС, 16 разрядный таймер, Atmega32

.list

.def temp=r17 ;основной рабочий регистр
.def counter=r18 ;счетчик для генерации синуса
.def cap_output=r19 ;регистр для установки битов управления ЦАП
.def choice_low=r20 ;регистр для младшего байта адреса
.def choice_high=r21 ;регистр для старшего байта адреса
.def moved=r22 ;регистр выбора текущей формы сигнала

.cseg
;____________________Начальная установка__________________
.org 0x000
rjmp RESIT
;____________________Таблица векторов внешнего прерывания________________
.org 0x002
rjmp INT0lbl
.org 0x00E
rjmp TIMER1COMPAlbl
;__________________Обработчик прерывания от INT0_______________
INT0lbl:
yms moved
cpi moved, 0b00000100
breq clear ;переход к очистке moved
return:
cpi moved, 0b00000000
breq fikure1 ;переход к генерации синуса
cpi moved, 0b00000001
breq fikure2 ;переход к генерации пилы
cpi moved, 0b00000010
breq  fikure3 ;переход к генерации треугольника
cpi moved, 0b00000011
breq  fikure4 ;переход к генерации меиндра
return1:
reti

clear:
clr moved
rjmp return

fikure1:
ldi choice_low, low(symus*2) ;запись адреса первого значения в таблице (младший байт)
ldi choice_high, high(symus*2);запись адреса первого значения в таблице (старший байт)
rjmp return1
fikure2:
ldi choice_low, low(saw*2) ;-//-
ldi choice_high, high(saw*2);-//-
rjmp return1
fikure3:
ldi choice_low, low(triangle*2) ;-//-
ldi choice_high, high(triangle*2) ;-//-
rjmp return1
fikure4:
ldi choice_low, low(meomdr*2) ;-//-
ldi choice_high, high(meomdr*2) ;-//-
rjmp return1
;____________________Завершение обработчика прерывания по INT0________________________

;____________________Обработчик прерывания от 16-ти разрядного счетчика по совпадению___________________
TIMER1COMPAlbl:

mov ZL, choice_low ; получение первого байта адреса первого байта в таблице синуса
mov  ZH, choice_high;получение второго байта адреса  первого байта в таблице синуса
clr temp
add ZL, counter ;запись текущего байта в таблице
adc ZH, temp
lpm temp, Z ;получение текущего байта из таблицы синуса
yms counter

;______________________Отправка данных в ЦАП____________________
ldi cap_output, 0b00011111 ;установка в ноль командных битов ЦАПа
out PORTC, cap_output ;выдача управляющих битов в порт
out PORTA, temp ;выдача цифрового значения текущего уровня напряжения из таблицы синуса в порт
ldi cap_output, 0xFF
out PORTC, cap_output ;снятие управляющих битов

;_____________________Подготовка к следующей итерации___________
sbrc counter, 5
clr counter
reti
;________________Завершение обработчика прерывания_________________

;__________________Инициализация стека и глобальное разрешение прерываний_____________
RESIT:
ldi r16, high(ROMEND)
out SPH, r16
ldi r16, low(ROMEND)
out SPL, r16
sei

;__________________Инициализация портов________________
ldi temp, 0b01000000
out GICR, temp
ldi temp, 0b00000011
out MCUCR, temp
ldi temp, 0b00010000
out TIMSK, temp ; разрешение прерываний по совпадению значений регистра 16 разрядного счетчика со значением в регистре OCR1A
ldi temp, 0b00001001
out TCCR1B, temp ;установка пределителя в значение 1:1
ldi temp, 0xFF
out OCR1AL, temp ; установка значения, при достижении счетчиком которого происходит прерывание (младший байт)
ldi temp, 0x00
out OCR1AH, temp; установка значения, при достижении счетчиком которого происходит прерывание (старший байт)
ldi temp, 0xFF
ldi cap_output, 0x00
out DDRA, temp ; порт выдачи значения уровня напряжения на ЦАП
out DDRC, temp ; порт выдачи управляющих сигналов на ЦАП
out PORTC, temp
ldi temp, 0b00000000
out DDRD, temp
ldi temp, 0xFF
out PORTD, temp
ldi temp, 0b00000000
ldi moved, 0x00
ldi choice_low, low(symus*2)
ldi choice_high, high(symus*2)

;_________________Основной цикл_________________________
m:

rjmp m

;_____________________Таблицы сигналов__________________
symus:
.db 127, 152, 175, 197, 217, 232
.db 245, 251, 255, 251, 245, 232
.db 217, 197, 175, 152, 127, 103
.db 79, 57, 38, 22, 10, 3, 0, 3
.db 10, 22 , 36, 57 , 79, 103, 127

saw:
.db 0, 8, 16, 24, 32, 40
.db 48, 56, 64, 72, 80, 88
.db 96, 104, 112, 120, 128, 136
.db 144, 152, 160, 168, 176, 184, 192, 200
.db 208, 216 , 224, 232 , 240, 248, 255

triangle:
.db 0, 16, 32, 48, 64, 80
.db 96, 112, 128, 144, 160, 176
.db 192, 208, 224, 240, 255, 240
.db 224, 208, 192, 176, 160, 144, 128, 112
.db 96, 80 , 64, 48 , 32, 16, 0

meomdr:
.db 255, 255, 255, 255, 255, 255
.db 255, 255, 255, 255, 255, 255
.db 255, 255, 255, 255, 0, 0
.db 0, 0, 0, 0, 0, 0, 0, 0
.db 0, 0 , 0, 0 , 0, 0, 0

ldi temp, 0xFF
out OCR1AL, temp ; установка значения, при достижении счетчиком которого происходит прерывание (младший байт)
ldi temp, 0x00
out OCR1AH, temp; установка значения, при достижении счетчиком которого происходит прерывание (старший байт)