     commSerial->begin(Protocol::BAUD_RATE);
     mpu.begin();
     gps.begin();
+    baro.begin();
+
+    delay(100);
+    baro.calibrate();
 }
 void loop(){
     updateGPS();
     readAccelerometer();
+    baro.update();
 
     static uint32_t outputTrack = millis();
     if(millis() > outputTrack){

    commSerial->print("\tupTime: ");
    commSerial->print(millis());
    commSerial->print("\n");
}

Waypoint        location(0,0);
LEA6H           gps;
MPU6000         mpu;
MS5611          baro;
HLA             pitch( 100, 0);
HLA             roll ( 100, 0);

