Hallo goara,

bzgl. Kalmanfilter
http://forum.mikrokopter.de/topic-5875.html

bzgl. PID Regler
http://forum.mikrokopter.de/topic-5864.html

Vielleicht hilft es ja weiter

Viele Grüße
ABSimon