An der Uni musste ich auch eine Regelung für ein Doppelpendel entwerfen. Ich habe mich damals für eine absolute Messung des Winkels am Gelenk entschieden. Damit hats dann sehr gut funktioniert. Vielleicht überdenkt ihr das Konzept nocheinmal.