öhm, es gibt nur C für AVRs soweit ich weiß...

Das Problem ist die zeitlich exakte Ansteuerung der Servos unter jeder Bedingung!