Height and vertical velocity Kalman filtering on MS5611 barometer: part 2
Adding accelerometer data to the Kalman filter In my last post I wrote about a Kalman filter to take the MS5611 barometer data and derive both the quadcopter height, and the vertical velocity. It worked reasonably well but there was a compromise between noise and latency of the filter. To get even better results, I have incorporated now the accelerometer. We could produce a new Kalman filter using the height, velocity and acceleration in the state vector, but it turns out we can simply amend our previous filter and include the acceleration in the control vector to improve the predicted state.