Микроконтроллеры AVR

Подключил к Меге8 Энкодер. Сваял обработчик, но не рабочий... Может кто подскажет, гляньте мой код, Заранее Спасибо ! ;) PortC0 и PortC1 - лапки энкодера. srv_angle - параметр, которых меняю энкодером. srv_an_pr - Предыдущее считанное значение положения энкодера. ReadEncoder: // Входим в обработчик in Temp0,PortC // Читаем Порт ldi Temp1,0 RE_Pau: // Пауза dec Temp1 brne RE_Pau andi Temp0,0b00000011 //Образали по маске значение энкодера andi srv_an_pr,3 //Обрезали предыдущее значение RE_nx1: cpi Temp0,1 // Сравнили с 1 brne RE_nx2 cpi srv_an_pr,3 // Пред. знач сравнили с 3 brne RE1 inc srv_angle rjmp RE_Ex RE1: cpi srv_an_pr,0 // Пред. знач сравнили с 0 brne RE_Ex dec srv_angle rjmp RE_Ex RE_nx2: cpi Temp0,2 // Сравнили с 2 brne RE_nx3 cpi srv_an_pr,0 // Пред. знач сравнили с 0 brne RE2 inc srv_angle rjmp RE_Ex RE2: cpi srv_an_pr,3 // Пред. знач сравнили с 3 brne RE_Ex dec srv_angle rjmp RE_Ex RE_nx3: cpi Temp0,3 // Сравнили с 3 brne RE_n0 cpi srv_an_pr,2 // Пред. знач сравнили с 2 brne RE3 inc srv_angle rjmp RE_Ex RE3: cpi srv_an_pr,1 // Пред. знач сравнили с 1 brne RE_Ex dec srv_angle rjmp RE_Ex RE_n0: cpi srv_an_pr,1 // Пред. знач сравнили с 1 brne RE0 inc srv_angle rjmp RE_Ex RE0: cpi srv_an_pr,2 // Пред. знач сравнили с 2 brne RE_Ex dec srv_angle rjmp RE_Ex RE_Ex: mov srv_an_pr,Temp0 ret