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

[Chip]

C I2C все просто

Можешь проверить вот этот скетч, мне итересно будут с ним сервы дергаться? Если все нормально то можно будет запускать эту процедуру в фоновом режиме через прерывание таймера, например каждые 20мкс
будет производится копирование порта

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

void loop() 
{
uint8_t Result;
asm volatile( 
"cli" "\n\t"             
"label%=:"  "in %[Result], %[in_porta]"   "\n\t"
            "out %[out_portc],  %[Result]" "\n\t"
"rjmp label%=" "\n\t"

        : [Result] "=r" (Result)
        : [out_portc] "I" (_SFR_IO_ADDR(PORTC)), [in_porta] "I" (_SFR_IO_ADDR(PINA))   
        );
    
sei();
}