GPX out read logged alt in dm for Betaflight 4 (#25)

GPX out read logged alt in dm for Betaflight 4

src/blackbox_decode.c

@@ -454,11 +454,26 @@ void outputGPSFields(flightLog_t *log, FILE *file, int64_t *frame)
     }
 }
 
+int getMajorVersion(flightLog_t *log)
+{
+    if (!log->private->fcVersion[0]) {
+        return -1; //Unknown version
+    }
+    char fcVersion[30];
+    strcpy(fcVersion, log->private->fcVersion);
+    return atoi(strtok(fcVersion, "."));
+}
+
 /**
- * Get altitude in [m] from betaflight logged [cm], including optional user altitude offset.
+ * Get altitude in [m] including optional user altitude offset.
+ * Note: Betaflight before version 4 logged altitude in [cm], since Betaflight 4 it use [dm].
  */
-float getAltitude(flightLog_t *log, int64_t *frame) {
-	return frame[log->gpsFieldIndexes.GPS_altitude] / 100.0 + options.altOffset; //Change [cm] to [m] for gpx format
+float getAltitude(flightLog_t *log, int64_t *frame)
+{
+    int majorFcVersion = getMajorVersion(log);
+    float unitFactor = majorFcVersion < 4 ? 0.01 : 0.1; //The logged altitude was changed from centimeter to decimeter since Betaflight 4.0.0.RC1
+    return frame[log->gpsFieldIndexes.GPS_altitude] * unitFactor
+            + options.altOffset; //Change [cm] to [m] for gpx format
 }
 
 void outputGPSFrame(flightLog_t *log, int64_t *frame)

src/parser.c

@@ -392,6 +392,16 @@ static size_t parseHeaderLine(flightLog_t *log, mmapStream_t *stream, ParserStat
             log->sysConfig.firmwareType = FIRMWARE_TYPE_CLEANFLIGHT;
         else
             log->sysConfig.firmwareType = FIRMWARE_TYPE_BASEFLIGHT;
+    } else if (strcmp(fieldName, "Firmware revision") == 0) {
+        char fieldCopy[200];
+        strcpy(fieldCopy, fieldValue);
+        char* fcName = strtok(fieldCopy, " "); //Read firmware name
+        if (!strcmp(fcName, "Betaflight")) { //Version text location known for Betaflight firmware
+            char* fcVersion = strtok(NULL, " "); //Firmware version text
+            strcpy(log->private->fcVersion, fcVersion);
+        } else {
+            log->private->fcVersion[0] = 0; //Indicate that firmware version unknown
+        }
     } else if (strcmp(fieldName, "minthrottle") == 0) {
         log->sysConfig.minthrottle = atoi(fieldValue);
 

src/parser.h

@@ -177,6 +177,8 @@ typedef struct flightLogPrivate_t
 {
     int dataVersion;
 
+    char fcVersion[30];
+
     // Blackbox state:
     int64_t blackboxHistoryRing[3][FLIGHT_LOG_MAX_FIELDS];