Der Mega 644 hat 2 hardware PWM units mit 16 Bit Auflösung. Die eignen sich wunderbar für die Servosteuerung.

Der Code hier sieht ziehmlich ineffektiv aus, auch wenn man wegen der fehlenden Teile nicht alles versteht. Es geht auch einen Effektiven Code für Software PWM zur Steuerung von mehr Servos zu erzeugen. Das Setzen der IO ports sollte zum Beispiel in der ISR erfolgen, und nicht in der schleife im Hauptprogramm. Wenn die Rechenzeit sehr knapp ist, kann man auch die Servopulse nacheinander erzeugen, also immer nur einen zur Zeit.