   if(debugMode) {
     listenCommanader();
   } else {
-    barometer.readTempC();
-
-    if(altReference==-900) {
-      altReference = barometer.readFloatAltitudeMeters();
+    if(altReference == -900) {
+      altReference = bmp.readPressure();
       delay(50);
     }
     
-    float lastAlt = barometer.readFloatAltitudeMeters() - altReference;
+    float lastAlt = bmp.readAltitude(altReference);
 
     Serial.print("Current Altitude (m): ");
     Serial.println(lastAlt);

  Serial.begin(115200);
  Serial.println("Altimeter v1.0 - Equipe Rocket 2017");
  
  barometer.settings.commInterface = I2C_MODE;
  barometer.settings.I2CAddress = 0x76;
  barometer.settings.runMode = 3;
  barometer.settings.tStandby = 0;
  barometer.settings.filter = 4;
  barometer.settings.tempOverSample = 5;
  barometer.settings.pressOverSample = 5;
  barometer.settings.humidOverSample = 1;
  delay(50);
  barometer.begin();
  delay(50);

  Wire.begin();



    updateEntriesCount(entriesCounter);

    delay(960/SAMPLING);
  }
}
