most functionality to splashdwon, find neutral and start mission. short timeouts still in code for testing, will adjust to go directly to sit_idle after splashdown

Dependencies:   mbed MODSERIAL FATFileSystem

Revision:
85:dd8176285b6e
Parent:
67:c86a4b464682
--- a/omegaPX209/omegaPX209.cpp	Tue Feb 19 20:11:43 2019 +0000
+++ b/omegaPX209/omegaPX209.cpp	Mon Feb 25 21:26:34 2019 +0000
@@ -71,6 +71,14 @@
 
     return depth_ft;
 }
+float omegaPX209::getDepthM() {
+    float psi = getPsi() - _zeroPsi; // read the sensor and remove atmospheric bias
+    float Pa = psi2Pa * psi; // convert psi to Pascals
+    float depth_m = Pa / (water_density_kg_m3 * grav_m_s2); // convert Pa to fluid depth in meters
+    // float depth_ft = m2ft * depth_m; // convert meters to feet
+
+    return depth_m;
+}
 
 // call this if you want to tare to zero
 void omegaPX209::tare() {