Add isPresent test functions for LG290P and mosaic

Author: nseidle

Firmware/RTK_Everywhere/GNSS.ino

@@ -46,12 +46,18 @@ float GNSS::getSurveyInStartingAccuracy()
 //----------------------------------------
 // Returns true if the antenna is shorted
 //----------------------------------------
-bool GNSS::isAntennaShorted() { return false; }
+bool GNSS::isAntennaShorted()
+{
+    return false;
+}
 
 //----------------------------------------
 // Returns true if the antenna is shorted
 //----------------------------------------
-bool GNSS::isAntennaOpen() { return false; }
+bool GNSS::isAntennaOpen()
+{
+    return false;
+}
 
 //----------------------------------------
 // Set the minimum satellite signal level for navigation.
@@ -98,3 +104,106 @@ void pushGPGGA(char *ggaData)
     }
 #endif // COMPILE_NETWORK
 }
+
+// Detect what type of GNSS receiver module is installed
+// using serial or other begin() methods
+// To reduce potential false ID's, record the ID to NVM
+// If we have a previous ID, use it
+void gnssDetectReceiverType()
+{
+    // Currently only the Flex requires GNSS receiver detection
+    if (productVariant != RTK_FLEX)
+        return;
+
+    // settings.detectedGnssReceiver = GNSS_RECEIVER_LG290P;
+    // gnss = (GNSS *)new GNSS_LG290P();
+    // systemPrintln("Starting GNSS receiver: LG290P");
+    // return;
+
+    gnssBoot(); // Tell GNSS to run
+
+    // TODO remove after testing, force retest on each boot
+    settings.detectedGnssReceiver = GNSS_RECEIVER_UNKNOWN;
+
+    // Start auto-detect if NVM is not yet set
+    if (settings.detectedGnssReceiver == GNSS_RECEIVER_UNKNOWN)
+    {
+#ifdef COMPILE_LG290P
+        if (lg290pIsPresent() == true)
+        {
+            settings.detectedGnssReceiver = GNSS_RECEIVER_LG290P;
+            recordSystemSettings(); // Record the detected GNSS receiver and avoid this test in the future
+        }
+#else  // COMPILE_LGP290P
+        systemPrintln("<<<<<<<<<< !!!!!!!!!! LG290P NOT COMPILED !!!!!!!!!! >>>>>>>>>>");
+#endif // COMPILE_LGP290P
+
+#ifdef COMPILE_MOSAICX5
+// TODO - this uses UART2, but Flex is UART1. We need to make the mosaic send routines flexible to use
+// whichever UART we specify.
+// if (mosaicIsPresent() == true)
+//     settings.detectedGnssReceiver = GNSS_RECEIVER_MOSAIC_X5;
+// recordSystemSettings(); // Record the detected GNSS receiver and avoid this test in the future
+#else  // COMPILE_MOSAICX5
+        systemPrintln("<<<<<<<<<< !!!!!!!!!! MOSAICX5 NOT COMPILED !!!!!!!!!! >>>>>>>>>>");
+#endif // COMPILE_MOSAICX5
+    }
+
+    // Start the detected receiver
+    if (settings.detectedGnssReceiver == GNSS_RECEIVER_LG290P)
+    {
+#ifdef COMPILE_LG290P
+        gnss = (GNSS *)new GNSS_LG290P();
+        present.gnss_lg290p = true;
+        systemPrintln("Starting GNSS receiver: LG290P");
+#endif // COMPILE_LGP290P
+    }
+    else if (settings.detectedGnssReceiver == GNSS_RECEIVER_MOSAIC_X5)
+    {
+#ifdef COMPILE_MOSAICX5
+        gnss = (GNSS *)new GNSS_MOSAIC();
+        present.gnss_mosaicX5 = true;
+        systemPrintln("Starting GNSS receiver: mosaic-X5");
+#endif // COMPILE_MOSAICX5
+    }
+
+    // Auto ID failed, mark everything as unknown
+    else if (settings.detectedGnssReceiver == GNSS_RECEIVER_UNKNOWN)
+    {
+        gnss = (GNSS *)new GNSS_None();
+    }
+}
+
+// Based on the platform, put the GNSS receiver into run mode
+void gnssBoot()
+{
+    if (productVariant == RTK_TORCH)
+    {
+        digitalWrite(pin_GNSS_DR_Reset, HIGH); // Tell UM980 and DR to boot
+    }
+    else if (productVariant == RTK_FLEX)
+    {
+        gpioExpanderGnssBoot(); // Drive the GNSS reset pin high
+    }
+    else if (productVariant == RTK_POSTCARD)
+    {
+        digitalWrite(pin_GNSS_Reset, HIGH); // Tell LG290P to boot
+    }
+}
+
+// Based on the platform, put the GNSS receiver into reset
+void gnssReset()
+{
+    if (productVariant == RTK_TORCH)
+    {
+        digitalWrite(pin_GNSS_DR_Reset, LOW); // Tell UM980 and DR to reset
+    }
+    else if (productVariant == RTK_FLEX)
+    {
+        gpioExpanderGnssReset(); // Drive the GNSS reset pin low
+    }
+    else if (productVariant == RTK_POSTCARD)
+    {
+        digitalWrite(pin_GNSS_Reset, LOW); // Tell LG290P to reset
+    }
+}

Firmware/RTK_Everywhere/GNSS_LG290P.ino

@@ -192,9 +192,9 @@ bool GNSS_LG290P::configureGNSS()
         // If we fail, reset LG290P
         systemPrintln("Resetting LG290P to complete configuration");
 
-        lg290pReset();
+        gnssReset();
         delay(500);
-        lg290pBoot();
+        gnssBoot();
     }
 
     systemPrintln("LG290P failed to configure");
@@ -2329,15 +2329,6 @@ uint32_t GNSS_LG290P::baudGetMaximum()
 }
 
 //----------------------------------------
-void lg290pBoot()
-{
-    digitalWrite(pin_GNSS_Reset, HIGH); // Tell LG290P to boot
-}
-
-void lg290pReset()
-{
-    digitalWrite(pin_GNSS_Reset, LOW);
-}
 
 // Given a NMEA or PQTM sentence, determine if it is enabled in settings
 // This is used to signal to the processUart1Message() task to remove messages that are needed
@@ -2392,4 +2383,36 @@ bool lg290pMessageEnabled(char *nmeaSentence, int sentenceLength)
     return (true);
 }
 
+// Return true if we detect this receiver type
+bool lg290pIsPresent()
+{
+    // Locally instantiate the hardware and library so it will release on exit
+
+    HardwareSerial serialTestGNSS(2);
+
+    // LG290P communicates at 460800bps.
+    uint32_t platformGnssCommunicationRate = 115200 * 4;
+
+    // systemPrintf("Starting GNSS primary UART at %d on pins RX: %d TX: %d\r\n", platformGnssCommunicationRate,
+    //              pin_GnssUart_RX, pin_GnssUart_TX);
+
+    serialTestGNSS.begin(platformGnssCommunicationRate, SERIAL_8N1, pin_GnssUart_RX, pin_GnssUart_TX);
+
+    LG290P lg290p;
+
+    if (lg290p.begin(serialTestGNSS) == true) // Give the serial port over to the library
+    {
+        // if (settings.debugGnss)
+        systemPrintln("LG290P detected");
+        serialTestGNSS.end();
+        return true;
+    }
+
+    if (settings.debugGnss)
+        systemPrintln("LG290P not detected. Moving on.");
+
+    serialTestGNSS.end();
+    return false;
+}
+
 #endif // COMPILE_LG290P

Firmware/RTK_Everywhere/GNSS_Mosaic.h

@@ -858,6 +858,9 @@ class GNSS_MOSAIC : GNSS
 
     bool isPppConverging();
 
+    // Send commands out the UART to see if a mosaic module is present
+    bool isPresent();
+
     // Some functions (L-Band area frequency determination) merely need
     // to know if we have an RTK Fix.  This function checks to see if the
     // given platform has reached sufficient fix type to be considered valid