Logs and Telemetry decorrelated. Telemetry helpers. Possibility to reset the altitude. Flash optimizations.

src/logs.cpp

@@ -0,0 +1,158 @@
+/*
+ * Authors (alphabetical order)
+ * - Bertrand Songis <bsongis@gmail.com>
+ * - Bryan J. Rentoul (Gruvin) <gruvin@gmail.com>
+ *
+ * Original contributors
+ * - Philip Moss Adapted first frsky functions from jeti.cpp code by
+ * - Karl Szmutny <shadow@privy.de>
+
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published
+ * by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ */
+
+#include "gruvin9x.h"
+#include "ff.h"
+
+// "/G9XLOGS/M00_000.TXT\0" max required length = 21
+char g_logFilename[22];
+
+// These global so we can close any open file from anywhere
+FATFS FATFS_Obj;
+FIL g_oLogFile;
+int8_t g_logState = 0; // 0=closed, >0=opened, <0=error
+
+void startLogs()
+{
+  // Determine and set log file filename
+  FRESULT result;
+
+  // close any file left open. E.G. Changing models with log switch still on.
+  if (g_oLogFile.fs) f_close(&g_oLogFile);
+  g_logState = 0;
+
+  strcpy_P(g_logFilename, PSTR("/G9XLOGS/M00_000.TXT"));
+
+  uint8_t num = g_eeGeneral.currModel + 1;
+  char *n = &g_logFilename[11];
+  *n = (char)((num % 10) + '0');
+  *(--n) = (char)((num / 10) + '0');
+
+  result = f_mount(0, &FATFS_Obj);
+  if (result!=FR_OK)
+  {
+    strcpy_P(g_logFilename, PSTR("FILE SYSTEM ERROR"));
+    g_logState = -result;
+    return;
+  }
+
+  // Skip over any existing log files ... _000, _001, etc. (or find first gap in numbering)
+  while (1)
+  {
+    result = f_open(&g_oLogFile, g_logFilename, FA_OPEN_EXISTING | FA_READ);
+    if (result == FR_OK)
+    {
+      f_close(&g_oLogFile);
+
+      // bump log file counter (file extension)
+      n = &g_logFilename[15];
+      if (++*n > '9')
+      {
+        *n='0';
+        n--;
+        if (++*n > '9')
+        {
+          *n='0';
+          n--;
+          if (++*n > '9')
+          {
+            *n='0';
+            break; // Wow. We looped back around past 999 to 000! abort loop
+          }
+        }
+      }
+    }
+    else if (result == FR_NO_FILE /*TODO check this code*/)
+    {
+      break;
+    }
+    else if (result == FR_NO_PATH)
+    {
+      if (f_mkdir("/G9XLOGS") != FR_OK)
+      {
+        strcpy_P(g_logFilename, PSTR("Check /G9XLOGS folder"));
+        g_logState = -result;
+        return;
+      }
+    }
+    else
+    {
+      g_logState = -result;
+      if (result == FR_NOT_READY)
+        strcpy_P(g_logFilename, PSTR("DATA CARD NOT PRESENT"));
+      else
+        strcpy_P(g_logFilename, PSTR("DATA CARD ERROR"));
+      return;
+    }
+  }
+
+  // g_logFilename should now be set appropriately.
+}
+
+// TODO FORCEINLINE this function
+void doLogs()
+{
+  FRESULT result;
+
+  if (isFunctionActive(FUNC_LOGS))
+  {
+    if (g_logState==0)
+    {
+      result = f_mount(0, &FATFS_Obj);
+      if (result != FR_OK)
+      {
+        g_logState = -result;
+        beepAgain = result - 1;
+        beepKey();
+      }
+      else
+      {
+        // create new log file using filename set up in startLogs()
+        result = f_open(&g_oLogFile, g_logFilename, FA_OPEN_ALWAYS | FA_WRITE);
+        if (result != FR_OK)
+        {
+          g_logState = -result;
+          beepAgain = result - 1;
+          beepKey();
+        }
+        else
+        {
+          f_lseek(&g_oLogFile, g_oLogFile.fsize); // append
+          g_logState = 1;
+          beepWarn2();
+        }
+      }
+    }
+
+    if (g_logState>0)
+    {
+      // TODO here we write logs
+    }
+  }
+  else if (g_logState > 0)
+  {
+    f_close(&g_oLogFile);
+    beepWarn2();
+    g_logState = 0;
+  }
+}
+
+
+