Diff: GloveBoxTester.cpp

Revision:

3:ae51b59d29b8

Parent:

2:73be4f9f04f9

Child:

4:9d0aa204aa20

--- a/GloveBoxTester.cpp	Tue Jul 16 19:03:26 2013 +0000
+++ b/GloveBoxTester.cpp	Tue Jul 23 15:30:46 2013 +0000
@@ -1,63 +1,106 @@
 #include "mbed.h"
 
-Serial pc(USBTX, USBRX);
+
 Serial lcd(p13,p14);
 
-DigitalOut pneumatics1(p11);
-DigitalOut pneumatics2(p12);
+DigitalOut pneumatics1(p25);
+DigitalOut pneumatics2(p26);
 DigitalOut box1(p23);
 DigitalOut box2(p22);
 DigitalOut box3(p21);
+DigitalIn  pause(p6);
+
+void clearLCD()
+{
+    lcd.printf("%c%c",0xFE,0x01);
+}
+void setLCDpos(int xpos, int ypos)
+{
+    int pos = 0x80;
+    switch (xpos) {
+        case 1:
+            pos +=0;
+            break;
+        case 2:
+            pos +=64;
+            break;
+        case 3:
+            pos +=20;
+            break;
+        case 4:
+            pos +=84;
+            break;
+    }
+    pos += (ypos-1);
+    lcd.printf("%c%c",0xFE,pos);
+}
+void setBrightness(int lev)
+{
+    lcd.printf("%c%c",0xFE,lev+127);
+
+    wait(.1);
+}
+//End LCD Setup
 
 
 int count = 1;
-int cycles = 5500;
-
+int cycles = 2500;
+int check = 0;
 
 
 
 int main()
 {
+    clearLCD();
+    setLCDpos(1,1);
+    lcd.printf("Here we go!");
+    while(count< cycles) {
 
-    pc.printf(" \n \rHere we go! \n \r");
-    while(count< cycles) {
+        if (pause) {
+            check = 1;
+            //Trigger solenoid
+            box1 = 1;
+            box2 = 0;
+            box3 = 0;
+            wait(.08);
+
+            box1 = 0;
+            box2 = 1;
+            wait(.08);
+
+            box2 = 0;
+            box3 = 1;
+            wait(.08);
 
 
-        //Trigger solenoid
-box1 = 1;
-box2 = 0;
-box3 = 0;
-wait(.3);
-
-box1 = 0;
-box2 = 1;
-wait(.3);
-
-box2 = 0;
-box3 = 1;
-wait(.3);
+            box3 = 0;
 
 
-box3 = 0;
-
+            //Wait until box completely opens then trigger pneumatics
+            wait(.7);
+            pneumatics1 = 1;
+            pneumatics2 = 0;
 
-        //Wait until box completely opens then trigger pneumatics
-        wait(.7);
-        pneumatics1 = 1;
-        pneumatics2 = 0;
+            //Wait until cylinder has finished travel
+            wait(.8);
+            pneumatics1 = 0;
+            pneumatics2 = 1;
+            wait(.5);
+            pneumatics2 =0;
 
-        //Wait until cylinder has finished travel
-        wait(.8);
-        pneumatics1 = 0;
-        pneumatics2 = 1;
+            //Wait to full retract then repeat
+            wait(5);
+          
+            count++;
+            setLCDpos(2,1);
+            lcd.printf("%d",count);
 
-        //Wait to full retract then repeat
-        wait(2);
-        pneumatics1 = 0;
-        pneumatics2 = 0;
-        pc.printf("%d\r",count);
-        count++;
+        }
+        else {
+            check = 0;
+        }
 
-
-    }
+        setLCDpos(3,1);
+        lcd.printf("%d", check); 
+    } 
 }