So, der Code wächst und gedeiht.
Mittlerweile kann ich auch Roh-Signale vom Gyro nutzen ohne DMP, dafür dann mit 1kHz

Umschaltbar in der config.h.
Ein moderater Low Pass Filter ist mit drin für das Gyro-Signal.
Für die Rollachse funktioniert das ordentlich, die Nick-Achse schwingt deutlich.
Roadmap:
- Das Gyro-Signal quasi als P-Anteil nutzen.
- I und D einbauen (Fehlerberechnung über Beschleunigungssensor, Referenzwert ist noch so ne Sache, ich will kein Horizont-Verschieben bei langgezogenen Kurven)