Added Basic Message No 19 and No 20 implementation

Added Basic Message No 19 and No 20 implementation

Author: JLJu

Software/Microcontroller/Firmware/AsgardADC/AsgardADC.ino

@@ -198,7 +198,8 @@ void acquisition()
   // Differential Pressure sensor
   if (AirDataComputer._status[AIRDC_STATUS_DELTAP] == '1') {     // Differential pressure sensor present
     diffp.update();
-    AirDataComputer._qc = diffp.pressure();
+    //AirDataComputer._qc = diffp.pressure();
+    AirDataComputer._qc = AirDataComputer.CorrectDp(1,diffp.pressure()); //Corrected Differential Pressure
     AirDataComputer._qcRaw = diffp.pressure_Raw();
     if (AirDataComputer._status[AIRDC_STATUS_TDELTAP] == '1') {   // Temperature differential pressure sensor present
       AirDataComputer._Tdeltap = diffp.temperature();
@@ -999,9 +1000,11 @@ endread:
     // --------------------------------------------------
     // #19 - CCS–CALIBRATION_CON_SET
     // --------------------------------------------------
+    //Example Sent -> $CCS,EXE,1,1
+    //
     if (!strcmp(command, "$CCS"))
     {
-      float SensorID, CalibMode;
+      float SensorID, CalibMode,CalibMeasure;
       if (strlen(command) < 1) goto endeval;
       command = strtok (NULL, SEPARATOR);   // Required command
       if (!strcmp(command, "EXE")) {        //Execute calibration command
@@ -1014,13 +1017,29 @@ endread:
           }
         }
       }
+      //Sospensive zero offset calibration
+      CalibMeasure=0;
+      if (AirDataComputer._status[AIRDC_STATUS_DELTAP] == '1') {     // Differential pressure sensor present
+      int maxip=50; //No. of samples to calculate the average zero value
+      for (int ip=0;ip<maxip;ip++)
+      {
+      diffp.update();
+      CalibMeasure = CalibMeasure+ diffp.pressure_Raw();
+      delay(200);
+      }
+      CalibMeasure = CalibMeasure/maxip;
+      AirDataComputer._DpZeroMeas=CalibMeasure;
+      }
       strcpy (Answer, "$CCA,");
       char f1[20], f2[20], f3[20];
       sprintf(f1, "%.3f", SensorID);
       strcat (Answer, f1);
       strcat (Answer, SEPARATOR);
       sprintf(f2, "%.3f", CalibMode);
       strcat (Answer, f2);
+      strcat (Answer, SEPARATOR);
+      sprintf(f3, "%.3f", AirDataComputer._DpZeroMeas);
+      strcat (Answer, f3);
       goto endeval;
     }
 

Software/Microcontroller/Libraries/AirDC/AirDC.cpp

@@ -58,6 +58,7 @@ AirDC::AirDC(int pid)
     _Iq=3;
     _Ir=0;
     _c=1; //Probe calibration factor
+    _DpZeroMeas=8192;
 
 }
 /** Calculates the Air Density
@@ -392,6 +393,19 @@ void AirDC::CalibrationFactor(int mode)
     }
     }
 }
+/** Calculates correction factor for differential pressure measurements (SI) taken by sensorID
+* @param  SensorID Indicates the Sensor
+* @param  Pascal deltap measurement
+* @return Correction Offset [Pa]
+ */
+double AirDC::CorrectDp(int SensorID, double DpMeas)
+{
+ //Hey ! We should use the SensorID!
+ //0.93513059
+ //0.8417479
+
+ return (DpMeas-(_DpZeroMeas-8192)*0.93513059);
+}
 /** Order all the data within an array
 * @return Void
  */

Software/Microcontroller/Libraries/AirDC/AirDC.h

@@ -71,6 +71,7 @@ class AirDC
     void Mach(int mode);
     void OAT(int mode);
     void ISAAltitude(int mode);
+    double CorrectDp(int SensorID, double DpMeas);
    String OutputSerial(int mode);
 //Correction and Auxiliary
     void PitotCorrection(int mode);
@@ -138,7 +139,9 @@ class AirDC
     double _Ip;/**< Pitch rate*/
     double _Iq;/**< Roll rate*/
     double _Ir;/**< yaw rate*/
-    double _c; /**Probe calibration factor*/
+    double _c; /**<Probe calibration factor*/
+//Sensor Specific
+    double _DpZeroMeas; /**<Zero measured value for differential sensor*/
 };
 #endif