Modified functions on baro and digital compass to achieve homogenity