wie wäre es am anfagn des servo-irq die interrupts abzuschalten und am ende wieder ein!?