Add median filtering of sonar data to I2C integral interface output