Wenn man schon Timer 1 (16 Bit) nimmt, kann man das Servosignal auch gleich im PWM mode erzeugen. Da kann man auch leicht 2 Kanäle machen. Einfach im PWM Mode starten und die Pulslänge in OCRx Register schreiben, den Rest macht die Hardware.