ШИМ для шагового двигателя

[V0lk]

Люди, знающие ассемблер пожалуйста помогите! мне нужно чтобы программа выдавала в порт D4 (контроллера ATmega 16) прямоугольный сигнал с частотой 488Гц (это предделитель 64) Скважностью 50%, допустим 5000 раз, т.е. 5000 дискрет для шагового двигателя, а потом уходить на действие Next2. Я вот тут кое что налепил, но оно по моему не работает. Пожалуйста проверьте, подскажите, помогите. Заранее спасибо!

Timer0_OV:   PUSHF
         PUSH   R17
         PUSH   R18
         PUSH   R19
      
         INCM   TCNT

         POP   R19
         POP   R18
         POP   R17
         POPF

         RETI
; End Interrupts ==========================================


Reset:      LDI    R16,Low(RAMEND)   ; Инициализация стека
          OUT    SPL,R16         ; Обязательно!!!

          LDI    R16,High(RAMEND)
          OUT    SPH,R16
   


; Internal Hardware Init  ======================================
         SETB   DDRD,4,R16   ; DDRD.4 = 1
         SETB   TIMSK,TOIE0,R16      ; Разрешаем прерывание

OUTI    TCCR1A,2<<COM1A0|2<<COM1B0|0<<WGM11|1<<WGM10   
OUTI    TCCR1B,0<<WGM13|1<<WGM12|011<<CS10        ;Предделитель =64

CLI
   OUTI   OCR1BH,0  ; Скважность 50%
   OUTI   OCR1BL,128
SEI


; Main =========================================================

Next:      LDS      R16,TCNT   ; Грузим числа в регистры
              LDS      R17,TCNT+1

         CPI      R16,0x13   ; Сравниванем побайтно
         BRCS   NoMatch
         CPI      R17,0x88
         BRCS   NoMatch

; Если совпало то отключаем таймер и идем к следующему шагу
Match:      OUTI   TCCR0,0<<CS00   

; Теперь надо обнулить счетчик, иначе за эту же итерацию главного цикла
; Мы сюда попадем еще не один раз -- таймер то не успеет натикать 255 значений
; чтобы число в первых двух байтах счетчика изменилось.

         CLR      R16            ; Нам нужен ноль
         OUTU   TCNT0,R16      ; Ноль в счетный регистр таймера
         STS      TCNT,R16      ; Ноль в первый байт счетчика в RAM
         STS      TCNT+1,R16      ; Ноль в второй байт счетчика в RAM
         STS      TCNT+2,R16      ; Ноль в третий байт счетчика в RAM
         STS      TCNT+3,R16      ; Ноль в первый байт счетчика в RAM
                       JMP Next2
; Не совпало - не делаем :)
NoMatch:   NOP

         INCM   CCNT         ; Шарманка вращается дальше, вхолостую

         JMP      Next

Next2:
NOP

[Valio]

Попробуй поковырять исходники готовых проектов

http://robozone.su/2009/01/05/kontro...atelja-na.html

хороший сайт...