Das sieht gut aus!
Aus Neugier:
Was für einen Code verwendest du für die Servos, konnte bis jetzt keinen brauchbaren (ausgereiften) finden und bin immer noch am Suchen!

Wäre es vlt. möglich den Code mal zu posten?

MFG erik_wolfram