Add pole length + ARP if tip altitude disabled during tilt

Reimplement @APOS80 PR #382

Author: nseidle

Firmware/RTK_Everywhere/Tilt.ino

@@ -588,6 +588,11 @@ void tiltApplyCompensationGNS(char *nmeaSentence, int arraySize)
     // Add interstitial between end of lon and beginning of alt
     strncat(newSentence, nmeaSentence + longitudeStop, altitudeStart - longitudeStop);
 
+    // If outputTipAltitude is enabled, then we don't have to make any adjustments: the tilt compensation module outputs tip altitude
+    // If outputTipAltitude is disabled, then we need to add back the pole length and ARP
+    if(settings.outputTipAltitude == false)
+        orthometricHeight = orthometricHeight + settings.tiltPoleLength + (present.antennaReferencePoint_mm / 1000.0);
+
     // Convert altitude double to string
     snprintf(coordinateStringDDMM, sizeof(coordinateStringDDMM), "%0.3f", orthometricHeight);
 
@@ -900,6 +905,11 @@ void tiltApplyCompensationGGA(char *nmeaSentence, int arraySize)
     // Add interstitial between end of lon and beginning of alt
     strncat(newSentence, nmeaSentence + longitudeStop, altitudeStart - longitudeStop);
 
+    // If outputTipAltitude is enabled, then we don't have to make any adjustments: the tilt compensation module outputs tip altitude
+    // If outputTipAltitude is disabled, then we need to add back the pole length and ARP
+    if(settings.outputTipAltitude == false)
+        orthometricHeight = orthometricHeight + settings.tiltPoleLength + (present.antennaReferencePoint_mm / 1000.0);
+
     // Convert altitude double to string
     snprintf(coordinateStringDDMM, sizeof(coordinateStringDDMM), "%0.3f", orthometricHeight);