Added simple barometric formula to MS5611 driver

include/sta/drivers/MS56xx.hpp

@@ -169,6 +169,10 @@ namespace sta
          * @return float The altitude estimate in meters.
          */
         float getAltitudeEstimate();
+
+        static float getSeaLevel(float pressRef, float altRef);
+
+        static float getAltitudeEstimate(float pressure, float sealevel);
     private:
         /**
          * @brief Reset the sensor.

src/MS56xx.cpp

@@ -121,6 +121,16 @@ namespace sta
         return altitude;
     }
 
+    float MS56xx::getSeaLevel(float pressRef, float altRef)
+    {
+    	return pressRef / (std::pow((1 - altRef / 44330), 5.255));
+    }
+
+    float MS56xx::getAltitudeEstimate(float pressure, float sealevel)
+    {
+    	return 44330 * (1 - std::pow(pressure / sealevel, 1 / 5.255));
+    }
+
     void MS56xx::readPROM() {
         uint8_t buffer[2];
 

src/mock.cpp

@@ -103,6 +103,16 @@ namespace sta
 		return altitude;
 	}
 
+	float MS56xx::getSeaLevel(float pressRef, float altRef)
+	{
+		return pressRef / (std::pow((1 - altRef / 44330), 5.255));
+	}
+
+	float MS56xx::getAltitudeEstimate(float pressure, float sealevel)
+	{
+		return 44330 * (1 - std::pow(pressure / sealevel, 1 / 5.255));
+	}
+
     void MS56xx::readPROM() {
         
     }