Add toggle pin option to system check sketch

Author: nseidle

Firmware/Test Sketches/System_Check/System_Check.ino

@@ -197,17 +197,47 @@ bool i2cBorked = false;
 void setup()
 {
   Serial.begin(115200);
+  delay(250);
+
+//  int pinNumber1 = 21;
+//  int pinNumber2 = 22;
+//  clearBuffer();
+//  pinMode(pinNumber1, OUTPUT);
+//  pinMode(pinNumber2, OUTPUT);
+//
+//  Serial.printf("\n\rToggling pin %d. Press x to exit\n\r", pinNumber1);
+//  Serial.printf("\n\rToggling pin %d. Press x to exit\n\r", pinNumber2);
+//
+//  while (Serial.available() == 0)
+//  {
+//    digitalWrite(pinNumber1, HIGH);
+//    digitalWrite(pinNumber2, HIGH);
+//    for (int x = 0 ; x < 100 ; x++)
+//    {
+//      delay(30);
+//      if (Serial.available()) break;
+//    }
+//
+//    digitalWrite(pinNumber1, LOW);
+//    digitalWrite(pinNumber2, LOW);
+//    for (int x = 0 ; x < 100 ; x++)
+//    {
+//      delay(30);
+//      if (Serial.available()) break;
+//    }
+//  }
+//  pinMode(pinNumber1, INPUT);
+//  pinMode(pinNumber2, INPUT);
+//
+//  Serial.println("Done");
 
   Wire.begin();
 
-  unsigned long startTime = millis();
-
   //begin/end wire transmission should take a few ms. If it's taking longer,
   //it's likely the I2C bus being shorted or pulled in
-
+  unsigned long startTime = millis();
   Wire.beginTransmission(0x15); //Dummy address
   int endValue = Wire.endTransmission();
-
   if (millis() - startTime > 100) i2cBorked = true;
 
   beginBoard(); //Determine what hardware platform we are running on and check on button

Firmware/Test Sketches/System_Check/menuSystem.ino

@@ -139,6 +139,7 @@ void menuSystem()
 
     Serial.println(F("s) Scan I2C"));
     Serial.println(F("S) Verbose scan of I2C"));
+    Serial.println(F("t) Toggle pin"));
     Serial.println(F("r) Reset"));
 
     byte incoming = getByteChoice(menuTimeout); //Timeout after x seconds
@@ -213,7 +214,50 @@ void menuSystem()
         Serial.println();
       }
       Serial.println("Done");
-    }    else if (incoming == STATUS_GETBYTE_TIMEOUT)
+    }
+    else if (incoming == 't')
+    {
+      Serial.println("Select pin to toggle:");
+      Serial.println("0 - Stat LED");
+      Serial.println("21 - SDA");
+      Serial.println("22 - SCL");
+      Serial.println("23 - SD COPI");
+      Serial.println("13 - Power Control");
+      int pinNumber = getNumber(menuTimeout); //Timeout after x seconds
+
+      if (pinNumber >= 0 && pinNumber < STATUS_PRESSED_X)
+      {
+        Wire.end();
+        delete sd;
+
+        clearBuffer();
+        pinMode(pinNumber, OUTPUT);
+
+        Serial.printf("\n\rToggling pin %d. Press x to exit\n\r", pinNumber);
+
+        while (Serial.available() == 0)
+        {
+          digitalWrite(pinNumber, HIGH);
+          for (int x = 0 ; x < 100 ; x++)
+          {
+            delay(30);
+            if (Serial.available()) break;
+          }
+
+          digitalWrite(pinNumber, LOW);
+          for (int x = 0 ; x < 100 ; x++)
+          {
+            delay(30);
+            if (Serial.available()) break;
+          }
+        }
+        pinMode(pinNumber, INPUT);
+
+        Serial.println("Done");
+        ESP.restart();
+      }
+    }
+    else if (incoming == STATUS_GETBYTE_TIMEOUT)
     {
       //break;
     }

Firmware/Test Sketches/System_Check/support.ino

@@ -53,3 +53,83 @@ uint8_t getByteChoice(int numberOfSeconds)
 
   return (incoming);
 }
+
+//Get a string/value from user, remove all non-numeric values
+//Returns STATUS_GETNUMBER_TIMEOUT if input times out
+//Returns STATUS_PRESSED_X if user presses 'x'
+int64_t getNumber(int numberOfSeconds)
+{
+  clearBuffer();
+
+  //Get input from user
+  char cleansed[20]; //Good for very large numbers: 123,456,789,012,345,678\0
+
+  long startTime = millis();
+  int spot = 0;
+  while (spot < 20 - 1) //Leave room for terminating \0
+  {
+    while (Serial.available() == 0) //Wait for user input
+    {
+      delay(10); //Yield to processor
+      if (online.gnss == true)
+        i2cGNSS.checkUblox(); //Regularly poll to get latest data
+
+      if ( (millis() - startTime) / 1000 >= numberOfSeconds)
+      {
+        if (spot == 0)
+        {
+          Serial.println(F("No user input received. Do you have line endings turned on?"));
+          return (STATUS_GETNUMBER_TIMEOUT); //Timeout. No user input.
+        }
+        else if (spot > 0)
+        {
+          break; //Timeout, but we have data
+        }
+      }
+    }
+
+    //See if we timed out waiting for a line ending
+    if (spot > 0 && (millis() - startTime) / 1000 >= numberOfSeconds)
+    {
+      Serial.println(F("Do you have line endings turned on?"));
+      break; //Timeout, but we have data
+    }
+
+    byte incoming = Serial.read();
+    if (incoming == '\n' || incoming == '\r')
+    {
+      Serial.println();
+      break;
+    }
+
+    if ((isDigit(incoming) == true) || ((incoming == '-') && (spot == 0))) // Check for digits and a minus sign
+    {
+      Serial.write(incoming); //Echo user's typing
+      cleansed[spot++] = (char)incoming;
+    }
+
+    if (incoming == 'x')
+    {
+      return (STATUS_PRESSED_X);
+    }
+  }
+
+  cleansed[spot] = '\0';
+
+  int64_t largeNumber = 0;
+  int x = 0;
+  if (cleansed[0] == '-') // If our number is negative
+  {
+    x = 1; // Skip the minus
+  }
+  for ( ; x < spot ; x++)
+  {
+    largeNumber *= 10;
+    largeNumber += (cleansed[x] - '0');
+  }
+  if (cleansed[0] == '-') // If our number is negative
+  {
+    largeNumber = 0 - largeNumber; // Make it negative
+  }
+  return (largeNumber);
+}