finished 1st main kalman pass
Merge branch 'master' of https://github.com/proftom/QuadCopter