Drone(Quad) Auto Altitude Hold Control based on Barometer only

Auto altitude hold based on MS5611 Barometer.
There is a fluctuation because MS5611 has low frequency noise.
I would improve it by fuse accelerometer later.
Then it will be more stable.