Wenn ich dich richtig verstehe, hast du jetzt einen Schalter, der in seinem Zustand bleibt - und keinen Taster, bei dem sich der Arduino merken muss, ob und wie oft er schon gedrückt wurde?
Dann sind Interrupt-Kopfstände und Flankensuche überflüssig, und dein loop() sieht etwa so aus:
void loop(){
liesSchalterstellung();
berechneServoWinkel();
setzeServoWinkel();
}
Zum Kontrollieren von Servos gibt es eine Library, die die ganze Pulsweiten-Ansteuerung im Hintergrund Timer-gesteuert erledigt, schau' da mal rein.
Schönen Sonntag noch!