Indicate casting by cycling position LEDs

Author: nseidle

Firmware/RTK_Surveyor/RTK_Surveyor.ino

@@ -37,7 +37,6 @@
     Enable various debug outputs sent over BT
 
     TODO
-      Indicate successful casting
 */
 
 const int FIRMWARE_VERSION_MAJOR = 1;
@@ -233,6 +232,7 @@ uint32_t lastBaseLEDupdate = 0; //Controls the blinking of the Base LED
 uint32_t lastFileReport = 0; //When logging, print file record stats every few seconds
 long lastStackReport = 0; //Controls the report rate of stack highwater mark within a task
 uint32_t lastHeapReport = 0;
+uint32_t lastCasterLEDupdate = 0; //Controls the cycling of position LEDs during casting
 
 uint32_t lastSatelliteDishIconUpdate = 0;
 bool satelliteDishIconDisplayed = false; //Toggles as lastSatelliteDishIconUpdate goes above 1000ms

Firmware/RTK_Surveyor/States.ino

@@ -26,7 +26,7 @@ void updateSystemState()
             displayRoverFail(1000);
             return;
           }
-          
+
           stopWiFi(); //Turn off WiFi and release all resources
           startBluetooth(); //Turn on Bluetooth with 'Rover' name
 
@@ -215,8 +215,8 @@ void updateSystemState()
           {
             Serial.print(F("WiFi Status: "));
             switch (wifiStatus) {
-              case WL_NO_SSID_AVAIL: 
-                Serial.printf("SSID '%s' not detected\n\r", settings.wifiSSID); 
+              case WL_NO_SSID_AVAIL:
+                Serial.printf("SSID '%s' not detected\n\r", settings.wifiSSID);
                 break;
               case WL_NO_SHIELD: Serial.println(F("WL_NO_SHIELD")); break;
               case WL_IDLE_STATUS: Serial.println(F("WL_IDLE_STATUS")); break;
@@ -233,6 +233,10 @@ void updateSystemState()
 
       case (STATE_BASE_TEMP_WIFI_CONNECTED):
         {
+          digitalWrite(positionAccuracyLED_1cm, LOW);
+          digitalWrite(positionAccuracyLED_10cm, LOW);
+          digitalWrite(positionAccuracyLED_100cm, LOW);
+
           if (settings.enableNtripServer == true)
           {
             //Open connection to caster service
@@ -313,6 +317,8 @@ void updateSystemState()
       //Monitor connected state
       case (STATE_BASE_TEMP_CASTER_CONNECTED):
         {
+          cyclePositionLEDs();
+
           if (caster.connected() == false)
           {
             Serial.println(F("Caster no longer connected. Reconnecting..."));
@@ -372,8 +378,8 @@ void updateSystemState()
           {
             Serial.print(F("WiFi Status: "));
             switch (wifiStatus) {
-              case WL_NO_SSID_AVAIL: 
-                Serial.printf("SSID '%s' not detected\n\r", settings.wifiSSID); 
+              case WL_NO_SSID_AVAIL:
+                Serial.printf("SSID '%s' not detected\n\r", settings.wifiSSID);
                 break;
               case WL_NO_SHIELD: Serial.println(F("WL_NO_SHIELD")); break;
               case WL_IDLE_STATUS: Serial.println(F("WL_IDLE_STATUS")); break;
@@ -390,6 +396,10 @@ void updateSystemState()
 
       case (STATE_BASE_FIXED_WIFI_CONNECTED):
         {
+          digitalWrite(positionAccuracyLED_1cm, LOW);
+          digitalWrite(positionAccuracyLED_10cm, LOW);
+          digitalWrite(positionAccuracyLED_100cm, LOW);
+
           if (settings.enableNtripServer == true)
           {
             //Open connection to caster service
@@ -471,6 +481,8 @@ void updateSystemState()
       //Monitor connected state
       case (STATE_BASE_FIXED_CASTER_CONNECTED):
         {
+          cyclePositionLEDs();
+
           if (caster.connected() == false)
           {
             changeState(STATE_BASE_FIXED_WIFI_CONNECTED);

Firmware/RTK_Surveyor/System.ino

@@ -764,3 +764,32 @@ void reportHeap()
     }
   }
 }
+
+//Based on current LED state, blink upwards fashion
+//Used to indicate casting
+void cyclePositionLEDs()
+{
+  //Cycle position LEDs to indicate casting
+  if (millis() - lastCasterLEDupdate > 500)
+  {
+    lastCasterLEDupdate = millis();
+    if (digitalRead(positionAccuracyLED_100cm) == HIGH)
+    {
+      digitalWrite(positionAccuracyLED_1cm, LOW);
+      digitalWrite(positionAccuracyLED_10cm, HIGH);
+      digitalWrite(positionAccuracyLED_100cm, LOW);
+    }
+    else if (digitalRead(positionAccuracyLED_10cm) == HIGH)
+    {
+      digitalWrite(positionAccuracyLED_1cm, HIGH);
+      digitalWrite(positionAccuracyLED_10cm, LOW);
+      digitalWrite(positionAccuracyLED_100cm, LOW);
+    }
+    else //Catch all
+    {
+      digitalWrite(positionAccuracyLED_1cm, LOW);
+      digitalWrite(positionAccuracyLED_10cm, LOW);
+      digitalWrite(positionAccuracyLED_100cm, HIGH);
+    }
+  }
+}