Altitude_estimation

Altitude estimation with a three state EKF. Results are calculated with real sensor data. Figure one compares the result of the estimation with the result of the barometric sensor and with the result of the ultrasonic sensor. Figure two is the vertical velocity in navigation frame. Figure three is the vertical offset compensated acceleration in navigation frame.