Kalman filter integration

git-svn-id: https://afrodevices.googlecode.com/svn/trunk/baseflight@241 7c89a4a9-59b9-e629-4cfe-3a2d53b20e61