Support for barometer readings with BMP085, since readings are shit, need to test it with new sensors.GY-65 are shit.
some refactoring