Hallo,
wenn ich den Quelltext richtig verstehe, dann beschäftigt sich der Mikrocontroller über 10 Prozent seiner Zeit mit nichts anderem als abzuwarten bis er mal wieder einen Servoport umschalten muss. Interrupts sind in dieser Zeit gesperrt. Gibt es da nicht Probleme z.B. mit der IRCOMM ?