ERROR found in kalman code to do with negative sonar
kalmanny stuff
Merge branch 'master' of https://github.com/proftom/QuadCopter