GDL90: report WGS-84 ellipsoid altitude again as the 'Ownership Geome…

…tric Altitude' [skip ci]
lyusupov · Oct 14, 2021 · 5b89e28 · 5b89e28
1 parent c2bbee9
commit 5b89e28
Show file tree

Hide file tree

Showing 6 changed files with 12 additions and 4 deletions.
diff --git a/software/firmware/source/SoftRF/src/platform/CC13XX.h b/software/firmware/source/SoftRF/src/platform/CC13XX.h
@@ -189,6 +189,7 @@ extern SCSerial                 scSerial;
 //#define EXCLUDE_OLED_BARO_PAGE
 //#define EXCLUDE_LK8EX1
 #define USE_GNSS_PSM
+//#define USE_GDL90_MSL
 
 //#define USE_BASICMAC
 #define USE_TIME_SLOTS

diff --git a/software/firmware/source/SoftRF/src/platform/ESP32.h b/software/firmware/source/SoftRF/src/platform/ESP32.h
@@ -239,6 +239,7 @@ struct rst_info {
 
 /* Experimental */
 //#define USE_BLE_MIDI
+//#define USE_GDL90_MSL
 
 //#define EXCLUDE_GNSS_UBLOX    /* Neo-6/7/8 */
 #define ENABLE_UBLOX_RFS        /* revert factory settings (when necessary)  */

diff --git a/software/firmware/source/SoftRF/src/platform/STM32.h b/software/firmware/source/SoftRF/src/platform/STM32.h
@@ -223,6 +223,7 @@ typedef struct stm32_backup_struct {
 #define EXCLUDE_LED_RING         //  -    kb
 #define EXCLUDE_SOUND
 //#define USE_GNSS_PSM
+//#define USE_GDL90_MSL
 #define EXCLUDE_LK8EX1
 #define EXCLUDE_IMU
 

diff --git a/software/firmware/source/SoftRF/src/platform/nRF52.cpp b/software/firmware/source/SoftRF/src/platform/nRF52.cpp
@@ -271,7 +271,7 @@ static void nRF52_setup()
   ui = &ui_settings;
 
 #if 0
-  uint32_t reset_reason = getResetReason();
+  uint32_t reset_reason = readResetReason();
 
   if      (reset_reason & POWER_RESETREAS_RESETPIN_Msk)
   {

diff --git a/software/firmware/source/SoftRF/src/platform/nRF52.h b/software/firmware/source/SoftRF/src/platform/nRF52.h
@@ -257,6 +257,7 @@ struct rst_info {
 //#define USE_USB_MIDI
 //#define USE_BLE_MIDI
 //#define USE_PWM_SOUND
+//#define USE_GDL90_MSL
 //#define EXCLUDE_NUS
 #define EXCLUDE_BOARD_SELF_DETECT
 

diff --git a/software/firmware/source/SoftRF/src/protocol/data/GDL90.cpp b/software/firmware/source/SoftRF/src/protocol/data/GDL90.cpp
@@ -101,9 +101,13 @@ const GDL90_Msg_FF_ID_t msgFFid = {
   .ShortName    = {'S', 'o', 'f', 't', 'R', 'F', ' ', ' ' },
   .LongName     = {'S', 'o', 'f', 't', 'R', 'F',
                     ' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ' },
+#if !defined(USE_GDL90_MSL)
+  .Capabilities = {0x00, 0x00, 0x00, 0x00}, /* WGS-84 ellipsoid altitude for Ownship Geometric report */
+#else
   .Capabilities = {0x00, 0x00, 0x00, 0x01}, /* MSL altitude for Ownship Geometric report */
+#endif /* USE_GDL90_MSL */
 };
-#endif
+#endif /* DO_GDL90_FF_EXT */
 
 /* convert a signed latitude to 2s complement ready for 24-bit packing */
 static uint32_t makeLatitude(float latitude)
@@ -313,7 +317,7 @@ static void *msgOwnershipGeometricAltitude(ufo_t *aircraft)
 {
   uint16_t vfom = 0x000A;
 
-#if 0
+#if !defined(USE_GDL90_MSL)
   /*
    * The Geo Altitude field is a 16-bit signed integer that represents
    * the geometric altitude (height above WGS-84 ellipsoid),
@@ -328,7 +332,7 @@ static void *msgOwnershipGeometricAltitude(ufo_t *aircraft)
    * SkyDemon is the only known exception which uses WGS-84 altitude still.
    */
   uint16_t altitude = (int16_t)(aircraft->altitude * _GPS_FEET_PER_METER / 5);
-#endif
+#endif /* USE_GDL90_MSL */
 
   GeometricAltitude.geo_altitude  = ((altitude & 0x00FF) << 8) | ((altitude & 0xFF00) >> 8) ;
   GeometricAltitude.VFOM          = ((vfom & 0x00FF) << 8) | ((vfom & 0xFF00) >> 8);