Added loads of EKF related equations. More to come
Merge branch 'master' of https://github.com/proftom/QuadCopter