[Multicotteri] Elettronica : IMU, MCU, Sensori ed algoritmi di controllo

Ciao ragazzi, io sono in procinto di costruire un quadricottero, ho acquistato il necessario e ora sto provando a creare l'algoritmo per bilanciare due motori posti su un'asse (è la base di partenza) con scarsi risultati però.

Lavoro con un Arduino Mega2560 e un sensore giroscopio accelerometro GY-521, riesco a leggere i dati raw (che forse sono un po' ballerini) ma non ci sono dati aberranti. Volevo capire se avete consigli su un filtro semplice da utilizzare sui dati e la logica con la quale essi modificano l'output suoi motori. Se avete esempi consigli vi ringrazio molto anticipatamente.