replace BMP085 with MS5611, rework altitude hold