Управление сервоприводом.

[Mastar]

Наконец добрался к паяльнику.
Запустил переделанный скетч под свою мегу

unsigned char Byte_Port; 
void setup()  
{     
   for (int i=22; i < 30; i++) pinMode(i, INPUT); 
   for (int i=37; i > 30; i--) pinMode(i, OUTPUT);     
} 

void loop()  
{ 
PORTC = PINA;
} 

И даже тут немного подергивается серва, а когда напрямую к приемнику , то как вкопанная.
Попробовал такой вариант.

unsigned char Byte_Port; 
void setup()  
{     
   for (int i=22; i < 30; i++) pinMode(i, INPUT); 
   for (int i=37; i > 30; i--) pinMode(i, OUTPUT);     
} 

void loop()  
{ 
  int Sens = analogRead(16);
  PORTC = PINA;
} 

Задергалась сильнее, чем в прошлом варианте.

Забраковал и pulseIn, так как там из 10 подряд значений длительности ни одного не повторилось, хотя болтались в пределах 1493 - 1505.