Hallo,
freut mich. Das Grundgerüst vom Servocode ist universell anwendbar wie ich in letzter Zeit feststelle. In dem Fall hier habe ich die defines und bitset durch digitalWrite ersetzt. Dann macht das struct auch mehr Sinn wenn der Pin mit drin ist. Timer fetzen. 
Vielleicht könnten wir ja noch altou beim Multiplexing helfen, wobei ich mich damit noch nie ernsthaft beschäftigt habe.