очередная "Лампа настроения" с энкодером

После недели головной боли над неправильно работающим циклом вычисления цвета допилил прошивку к своей лампе настроения.
Микроконтроллер atmega32a (на самодельной макетке)
(почему такой монстр для такой фигни? да потому-что моя самодельная макетка сделана для 16й и 32й атмег, пока что без совместимости с аттинями, в планах сделать переходник с тиней и 8меги на DIP40 установленный на плате.
а код легко переносится на другие платформы
суть разработки заключается в полной разработке девайса, от идеи до реализации в готовом виде.
и да, это мой первый девайс который делается ОТ и ДО)
Светодиод обычный RGB с общим анодом, взят со светодиодной ленты. Катоды подключены к ШИМ выходам микроконтроллера через токоограничительные резисторы.
Энекодер самый обычный, с А В выходами, подключены к 1 и 2 пину порта А (0й пин не работает)
Цвет меняется вращением энкодера, направление учитывается.
765 цветов.

Прошу прощения, но пока я могу писать на микропаскале (в С пока плохо ориентируюсь)
Собственно код:

program main;

var 
    state: byte;
    new:byte;
    r_led,g_led,b_led:byte;

procedure step_up();           
begin                               
if (r_led>0) and (g_led<255) and (b_led=0) then 
                                            begin 
                                            dec(r_led); 
                                            inc(g_led); 
                                            end;
if (g_led>0) and (b_led<255) and (r_led=0) then 
                                            begin 
                                            dec(g_led); 
                                            inc(b_led); 
                                            end;
if (b_led>0) and (r_led<255) and (g_led=0) then 
                                            begin 
                                            dec(b_led); 
                                            inc(r_led); 
                                            end;
end;

procedure step_down();
begin
if (g_led>0) and (r_led<255) and (b_led=0) then 
                                            begin 
                                            dec(g_led); 
                                            inc(r_led); 
                                            end;
if (b_led>0) and (g_led<255) and (r_led=0) then 
                                            begin 
                                            dec(b_led); 
                                            inc(g_led); 
                                            end;
if (r_led>0) and (b_led<255) and (g_led=0) then 
                                            begin 
                                            dec(r_led); 
                                            inc(b_led); 
                                            end;
end;



procedure init_pwm();         //включение таймеров в режим PWM
begin
ddrd:=176;
TCCR1A.COM1A1:=1;
TCCR1A.COM1B1:=1;
TCCR1A.WGM10:=1;
TCCR1B.CS10:=1;
TCCR2.WGM20:=1;
TCCR2.COM21:=1;
TCCR2.CS20:=1;

r_led:=255;                   //красный 100%
g_led:=0;                     //зеленый 0%
b_led:=0;                     //синий   0%

end;


procedure encoder_scan();          //скан енкодера
                                   //пинА и пинВ энкодера подключены к
begin
new:=(pina)and(%00000110);         //пинА1 и пинА2 атмеги  
delay_us(100);                     //достаточно для работы
case state of                      //обработка сигнала с энкодера
     0: begin
        if new=4 then step_up;        //всю эту хрень с обработкой энкодера вывести в отдельный юнит
        if new=2 then step_down;
        end;
     2: begin
        if new=0 then step_up;
        if new=6 then step_down;
        end;
     6: begin
        if new=2 then step_up;
        if new=4 then step_down;
        end;
     4: begin
        if new=6 then step_up;
        if new=0 then step_down;
        end;
     end;
state:=new;

OCR1AL:=255-r_led;               // в компаратор таймера1А
OCR1BL:=255-g_led;               // в компаратор таймера1В
OCR2:=255-b_led;                 // в компаратор таймера2

end;





begin
DDRA:=%00000000;            //портА на вход
init_pwm;

while (1) do
begin
encoder_scan;  //бесконечно сканируем энкодер
end;
                     
end.

а вот и фотки макетки



и схема

правда светодиоды я тут в обратную сторону воткнул случайно