[Pitot] Velocity is now 0 if totalPressure is greater then staticPressure

src/shared/sensors/analog/Pitot/Pitot.h

@@ -59,15 +59,23 @@ public:
     {
         float totalPressure  = getTotalPressure();
         float staticPressure = getStaticPressure();
+        PitotData pitotSpeed;
+        if (totalPressure > staticPressure)
+        {
 
-        // clang-format off
             float gamma = 1.4f;
             float c     = sqrt(gamma * Constants::R * reference.refTemperature);
+            // clang-format off
             float M             = sqrt(((pow(totalPressure / staticPressure, (gamma - 1) / gamma)) - 1) * (2 / (gamma - 1)));
             // clang-format on
-
-        PitotData pitotSpeed;
             pitotSpeed.airspeed = M * c;
+            pitotSpeed.deltaP   = totalPressure - staticPressure;
+        }
+        else
+        {
+            pitotSpeed.airspeed = 0;
+            pitotSpeed.deltaP   = 0;
+        }
         pitotSpeed.timestamp = TimestampTimer::getTimestamp();
 
         return pitotSpeed;