2 files changed, 92 insertions, 0 deletions
diff --git a/examples/qa-slave-shield.cpp b/examples/qa-slave-shield.cpp
new file mode 100644
index 0000000..fcee9cf
--- /dev/null
+++ b/examples/qa-slave-shield.cpp
@@ -0,0 +1,49 @@
+// slave mode for QA shield
+
+#include "wirish.h"
+
+#define LED_PIN 13
+#define NUM_GPIO 38 // not the number of the max...
+
+int i;
+
+void setup()
+{
+    /* Set up the LED to blink  */
+    pinMode(LED_PIN, OUTPUT);
+    digitalWrite(LED_PIN, 1);
+
+    for(i=0; i<NUM_GPIO; i++) {
+        if(i==13) { continue; }
+        pinMode(i, OUTPUT);
+        digitalWrite(i,0);
+    }
+    //delay(5000);
+    SerialUSB.println("OK, starting...");
+
+}
+
+void loop() {
+    digitalWrite(LED_PIN,1);
+    delay(100);
+    digitalWrite(LED_PIN,0);
+
+    for(i=0; i<NUM_GPIO; i++) {
+        if(i==13) { continue; }
+        digitalWrite(i,1);
+        delay(5);
+        digitalWrite(i,0);
+        delay(5);
+    }
+}
+
+
+int main(void) {
+    init();
+    setup();
+
+    while (1) {
+        loop();
+    }
+    return 0;
+}
diff --git a/examples/test-session.cpp b/examples/test-session.cpp
index 1c0f628..bd58866 100644
--- a/examples/test-session.cpp
+++ b/examples/test-session.cpp
@@ -420,6 +420,48 @@ void loop() {
                     if((uint8)COMM.read() == (uint8)27) break;      // ESC
                 }
                 break;
+            case 43:  // '+'
+                COMM.println("Doing QA testing for 37 GPIO pins...");
+                // turn off LED
+                digitalWrite(LED_PIN, 0);
+                for(int i = 0; i<NUM_GPIO; i++) {
+                    pinMode(i, INPUT);
+                    gpio_state[i] = 0; //(uint8)digitalRead(i);
+                }
+                COMM.println("Waiting to start...");
+                while(digitalRead(0) != 1 && !COMM.available()) {
+                    continue;
+                }
+                for(int i=0; i<38; i++) {
+                    if(i==13) {
+                        COMM.println("Not Checking D13 (LED)");
+                        continue;
+                    }
+                    COMM.print("Checking D");
+                    COMM.print(i,DEC);
+                    while(digitalRead(i) == 0) continue;
+                    for(int j=0; j<NUM_GPIO; j++) {
+                        if(digitalRead(j) && j!=i) {
+                            COMM.print(": FAIL ########################### D");
+                            COMM.println(j, DEC);
+                            break;
+                        }
+                    }
+                    while(digitalRead(i) == 1) continue;
+                    for(int j=0; j<NUM_GPIO; j++) {
+                        if(digitalRead(j) && j!=i) {
+                            COMM.print(": FAIL with D");
+                            COMM.println(j, DEC);
+                            break;
+                        }
+                    }
+                    COMM.println(": Ok!");
+                }
+                for(int i = 0; i<NUM_GPIO; i++) {
+                    pinMode(i, OUTPUT);
+                    digitalWrite(i, 0);
+                }
+                break;
             default:
                 COMM.print("Unexpected: ");
                 COMM.println(input);
@@ -451,6 +493,7 @@ void print_help(void) {
     COMM.println("\tr: read in GPIO status changes and print them in realtime");
     COMM.println("\ts: output a sweeping SERVO PWM on all PWM channels");
     COMM.println("\tm: output serial data dumps on USART1 and USART3 with various rates");
+    COMM.println("\t+: test shield mode (for QA, will disrupt Serial2!)");
 
     COMM.println("Unimplemented:");
     COMM.println("\te: do everything all at once until new input");