Hmm, richtig. Das macht mehr Sinn.
Kann ich dann einfach die beiden PIDs für RPM nutzen und den Error des Kompass, je nach Richtung der Abweichung, auf den Error der RPM aufrechnen bzw. abziehen? (ggf. mit einem sinnvollen Faktor)


Ich hatte jetzt nicht erwartet, dass du den Code noch auf +-180° anpasst. Zur Veranschaulichung hat der erste Code gereicht.