Prinzipiell sieht die Regelstrecke so aus:

Sensordaten einlesen -> Filtern (einzelne Werte sind nutzlos wegen Störeinflüssen) -> Kopter stabilisieren und deine Befehle einspeisen -> Motoren ansteuern.

mfg