Mal eine etwas einfachere Lösung:
Bau neben dem Servo eine Reflexlichtschranke.
An dem Teil vom Servo was sich dreht, machst du eine kleine Scheibe mit weis-schwarzen linien von innen nach aussen.
Jetzt kannst du am pic, atmel oder wo auch immer zählen wie oft sich die scheibe dreht ( wie viele Balken gezählt worden sind).
Je mehr Balken du machst, desto genauer wird das Ergebniss.
Lesezeichen