Автоподстройка на скважности., На контроллере Тини-15. Опции

[Коляй]

Ребята, подскажите? Делаю автоподстройку нуля. А опыта мало совсем. Сигнал автоподстройки берётся с фильтра на ОУ, а на сам фильтр идёт прямоугольный сигнал с переменной скважностью, частотой 120-200 гц. Скважность меняется во времени уменьшаясь или увеличиваясь, в зависимости от состояния компаратора, который подключен к выходу усилителя на ОУ ( Ку-30), а на вход подается сигнал автоподстройки с фильтра, подмешанный к некоторому входному сигналу. Когда на выходе "0", сигнал близок к меандру. И т.д...
Как бы покрасивее всё это оформить програмно? Контроллер Тини-15, ИАР отказался с ним на СИ работать, придётся наверное Асм поднимать. Поделитесь пожалуйста кто что думает? Спасибо.

[Коляй]

Ребята, посмотрите пожалуйста код? Не работает как положено. Вобщем хорошо скважность меняется, но доходит до определённых мест и останавливается на 0,5 секунды, потом скачет вперёд, потом опять идёт плавно. Вот эти скачки то мне не к чему как раз. Весь смысл такой подстройки теряется. Наверное это происходит когда в регистр сравнения заносится число близкое к максимальному. Как бы от этого избавиться?

Код

#include <iotiny13.h>
#include <intrinsics.h>

__eeprom unsigned char raz @ 0x02;
unsigned char  adc, freq;
unsigned int skw;


void  pausa (unsigned int p)
{
  while (p)
  {
    p --;  
  }
}

void main()
{
  raz ++;
  if (raz > 0x14)
  {
    while(1)
    {}
  }
  
  /* CPU INIT */
  DDRB = 0x06;
  PORTB_Bit0 = 1;
  ADMUX = 0x22; //ADLAR. PINB_Bit4
  ADCSRA = 0xE5; // adc_on, neprerivno, clock/64, adc_start
  OCR0A= 0x80;//
  TIMSK0=0x06;//  COMP0A,  OVF0
  TCCR0B=0x01;// Start clock CK/1
  __enable_interrupt();


  while(1)
  {
    
  }
}


#pragma vector=TIM0_COMPA_vect
__interrupt void MyInterrupt (void)
{
  if (freq == (skw >> 8))
  {
    PORTB_Bit1 = 0;
    skw ++;
    OCR0A = skw;
  }
}


#pragma vector=TIM0_OVF_vect
__interrupt void MyInterrupt2 (void)
{
  freq++;
  if (freq >= 0x80)
  {
    freq = 0;
   PORTB_Bit1 = 1;
  }

}

[Коляй]

Или наоборот дальше от нуля отходить...
(чего то правки сообщения не нашол)