War im Urlaub, deshalb die späte Antwort.
Ich habe keine Schieberegister benutzt, sondern drei komplette Ports. Jedes Portbit hängt direkt an einem Servo.
Weiter benutze ich einen Timerinterrupt, der die Ports setzt. 16 Bit Auflösung für die PWMs habe ich aber nicht, sondern nur 8 Bit.
Die einzelnen PWMs werden im Hauptprogramm nach zeitlicher Dauer sortiert und in ein Array geschrieben, welches der Interrupt auswertet.
Die ganze Steuerung ist zu komplex, um sie hier kurz darzustellen.