Brennan McClure
Working version with debug and simulate mode
Dependencies: mbed Grove_LCD_RGB_Backlight DebounceIn
Revision 1:6d456a72fe63, committed 2019-09-19
- Comitter:
- bmcclure
- Date:
- Thu Sep 19 22:35:30 2019 +0000
- Parent:
- 0:2f5d939d4a4a
- Commit message:
- Working version with debug mode and simulate mode.
Changed in this revision
| main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 2f5d939d4a4a -r 6d456a72fe63 main.cpp
--- a/main.cpp Wed Sep 18 18:13:50 2019 +0000
+++ b/main.cpp Thu Sep 19 22:35:30 2019 +0000
@@ -2,11 +2,19 @@
#include "mbed.h"
#include "DebounceIn.h"
-//input
+
+#define OUT_OFF (0)
+#define OUT_ON (1)
+
+#define IN_OFF (1)
+#define IN_ON (0)
-DebounceIn doorClosed(p5); //Check door status
+
+//input
+DebounceIn doorClosed(p5); //Check door status
DebounceIn cycleStartBtt(p14); //cycle start button
-InterruptIn stopBtt(p15); //stop button
+DebounceIn stopBtt(p15); //stop button
+//InterruptIn stopBtt(p15); //stop button
//DigitalIn pot(p20);
//output
@@ -21,221 +29,416 @@
Grove_LCD_RGB_Backlight rgbLCD(p9, p10); //Timer display
+bool cancelPending = false;
+bool damperIsOpen;
+bool simulateMode = false;
I2C i2c(p9, p10);
//Serial pc(USBTX, USBRX);
+
//extern "C" void mbed_reset();
+// Function declarations
+void damperRotate(int damper);
+void fullLineItoA(int m, char* str);
+void countDown(int s); //countdown in sec
+void fullStop();
+void debugMode();
+
+
+
+int main()
+{
+ //on power up status
+ cycleStartBtt.mode(PullUp);
+ cycleStartBtt.set_debounce_us(1000);
+ cycleStartBtt.set_samples(100);
+ wait(.1);
+
+ doorClosed.mode(PullUp);
+ cycleStartBtt.set_debounce_us(1000);
+ cycleStartBtt.set_samples(100);
+ wait(.1);
+
+ stopBtt.mode(PullUp);
+ cycleStartBtt.set_debounce_us(1000);
+ cycleStartBtt.set_samples(100);
+ wait(.5);
+
+ rgbLCD.clear();
+ rgbLCD.setRGB(0x00, 0x66, 0xaa); //set the color
+ rgbLCD.locate(0,0);
+
+ if(cycleStartBtt == IN_ON && stopBtt == IN_ON)
+ {
+ simulateMode = true;
+ rgbLCD.print("Simulating.... ");
+ wait(5);
+ }
+ if(stopBtt == IN_ON)
+ {
+ debugMode();
+ }
+
+ //check for closed door before running fan
+ while(doorClosed!=IN_ON)
+ {
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("Close the door ");
+ wait(.25);
+ }
+
+ //Display startup countdown
+ //Startin up and prep the tank
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("Starting up... ");
+
+ vfd = OUT_OFF;
+ damperIsOpen = false; // Assert and run the opener once
+ damperRotate(1); //vent opened;
+ if(!simulateMode)
+ {
+ doorInterlock = OUT_ON;
+ fanRelay = OUT_ON;
+ }
+ greenRelay = OUT_OFF;
+ yellowRelay = OUT_OFF;
+ redRelay = OUT_OFF;
+
+ //start timer for 90sec
+ countDown(90);
+
+ //Tank is ready
+ rgbLCD.locate(0,0);
+ rgbLCD.print("Tank is ready! ");
+ greenRelay = OUT_ON; //green light on
+ doorInterlock = OUT_OFF; //interlock unlatched, ready to load material into the tank
+ fanRelay = OUT_OFF; //fan off
+
+ cancelPending = false;
+
+ while(1)
+ {
+ if(cancelPending)
+ {
+ cancelPending = false;
+
+ //Display status
+ greenRelay = OUT_OFF; //green light OFF
+ yellowRelay = OUT_OFF; //yellow light OFF
+ redRelay = OUT_ON; //turn red light ON
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("CYCLE STOPPED. ");
+ vfd = OUT_OFF; //pump off
+ if(doorClosed == IN_ON && !simulateMode)
+ {
+ doorInterlock = OUT_ON; //door latched
+ }
+ fanRelay = OUT_OFF; //fan stops
+ damperRotate(0); //damper closed
+
+ //wait 60sec
+ countDown(60);
+ doorInterlock=OUT_OFF; //door unlatched
+ rgbLCD.locate(0,0);
+ rgbLCD.print("Tank is ready! ");
+ }
+
+ if(doorClosed==IN_ON) //door closed
+ {
+ /*
+ * Get set up for the wash, and wait for the start button
+ */
+ rgbLCD.locate(0,1);
+ rgbLCD.print("Door closed ");
+ greenRelay = OUT_ON; //green light stays on
+ yellowRelay = OUT_OFF; //yellow light off
+ redRelay = OUT_OFF; //red light off
+ doorInterlock = OUT_OFF; //door unlocked
+ fanRelay = OUT_OFF;
+ while(cycleStartBtt != IN_ON && !(doorClosed == IN_OFF || cancelPending))
+ {
+ if(stopBtt == IN_ON)
+ {
+ cancelPending = true;
+ continue;
+ }
+ wait(.25);
+ }
+ if(doorClosed == IN_OFF || cancelPending)
+ {
+ continue;
+ }
+
+
+ /*
+ * Cycle start button pressed - wash for 2 minutes
+ */
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("CYCLE STARTED! ");
+ greenRelay = OUT_OFF; //green light off
+ yellowRelay = OUT_ON; //yellow light on
+ damperRotate(0); //vent close
+ fanRelay = OUT_OFF; //fan stop
+ if(!simulateMode)
+ {
+ doorInterlock = OUT_ON; //door locked
+ vfd = OUT_ON; //vfd for pump up to speed
+ }
+ countDown(120); //start timer for 2min
+ if(doorClosed == IN_OFF || cancelPending)
+ {
+ continue;
+ }
+
+
+ /*
+ * Finished washing - turn off the pump
+ */
+ vfd = OUT_OFF; //pump off
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("CYCLE FINISHED! ");
+ wait(1);
+ if(doorClosed == IN_OFF || cancelPending)
+ {
+ continue;
+ }
+
+
+ /*
+ * Drip dry after washing for 5 minutes
+ */
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("DRIP DRYING! ");
+ countDown(300);
+ if(doorClosed == IN_OFF || cancelPending)
+ {
+ continue;
+ }
+
+
+ /*
+ * Change the air out for 2 minutes
+ */
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("AIR CYCLING! ");
+ damperRotate(1); //vent opened
+ if(!simulateMode)
+ {
+ fanRelay = OUT_ON; //fan on
+ }
+ countDown(120);
+ if(doorClosed == IN_OFF || cancelPending)
+ {
+ continue;
+ }
+
+
+ /*
+ * Entire cycle is done, close up and go back to waiting
+ */
+ greenRelay = OUT_ON; //green light on
+ yellowRelay = OUT_OFF; //yellow light off
+ doorInterlock = OUT_OFF; //door unlocked
+ fanRelay = OUT_OFF; //fan off
+ damperRotate(0); //damperRelay=0; //vent closed
+ rgbLCD.clear();
+ rgbLCD.locate(0,0);
+ rgbLCD.print("Tank is ready! ");
+ }
+ else //door open
+ {
+ rgbLCD.locate(0,1);
+ rgbLCD.print("Door open ");
+ greenRelay = OUT_OFF; //green light OFF
+ redRelay = OUT_ON; //turn red light ON
+ yellowRelay = OUT_OFF;
+ fanRelay = OUT_OFF; //fan stops
+ damperRotate(1); //damperRelay=1; //damper closed
+ }
+
+ wait(1);
+ }
+}
+
+
+
+
void damperRotate(int damper) //damper condition
{
- if(damper==0)
+ if(damper==0 && damperIsOpen == true && !simulateMode)
{
- damperRelayAlt=1; //toggle damper relay
+ damperRelayAlt=OUT_ON; //toggle damper relay
+ rgbLCD.locate(0,1);
+ rgbLCD.print("Closing damper ");
wait(5);
- damperRelayAlt=0; //time out to reduce wear
+ damperRelayAlt=OUT_OFF; //time out to reduce wear
+ damperIsOpen = false;
+ }
+ else if(damper == 1 && damperIsOpen == false && !simulateMode)
+ {
+ damperRelay=OUT_ON; //toggle damper relay
+ rgbLCD.locate(0,1);
+ rgbLCD.print("Opening damper ");
+ wait(5);
+ damperRelay=OUT_OFF; //time out to reduce wear
+ damperIsOpen = true;
}
- else //damper==1
+}
+
+void fullLineItoA(int m, char* str)
+{
+ if(str == NULL)
+ {
+ return;
+ }
+
+ // Empty the array to 16 white spaces
+ for(int j=0; j < 16; j++)
{
- damperRelay=1; //toggle damper relay
- wait(5);
- damperRelay=0; //time out to reduce wear
+ str[j] = ' ';
}
+ str[16] = 0;
+
+ // Put our counter in it, with the least-significant digit in col 4.
+ int i = 3;
+ do
+ {
+ str[i] = m%10 + '0';
+ m /= 10;
+ i--;
+ }while(m > 0 && i >= 0);
}
void countDown(int s) //countdown in sec
{
- int m=0;
- char cnt[12]; // make a 'count' string
- for(m=s; m>0; m--)
- {
- sprintf(cnt, "%i ", m);
- rgbLCD.locate(0,1);
- rgbLCD.print(cnt);
- wait(1);
+ int m=0;
+ char count[12]; // make a 'count' string
+
+ for(m=s; m>0; m--)
+ {
+ if(stopBtt == IN_ON)
+ {
+ cancelPending = true;
+ break;
+ }
+
+ fullLineItoA(m, count);
+
+ rgbLCD.locate(0,1);
+ rgbLCD.print(count);
+
+ wait(1);
}
}
-void fullStop()
+
+void debugMode()
{
- if(stopBtt==0)
- {
- //Display status
- greenRelay=0; //green light OFF
- yellowRelay=0; //yellow light OFF
- redRelay=1; //turn red light ON
+ char displayLine1[17];
+ char displayLine2[17];
+ unsigned int count = 0;
+
rgbLCD.clear();
rgbLCD.locate(0,0);
- rgbLCD.print("CYCLE STOPPED. ");
- vfd=0; //pump off
- doorInterlock=1; //door latched
- wait(2);
- fanRelay=0; //fan stops
- damperRotate(0); //damperRelay=0; //damper closed
-
- //wait 60sec
- countDown(10);
- doorInterlock=0; //door unlatched
+ do
+ {
+ strcpy(displayLine1, "Door= ");
+ if(doorClosed == 1)
+ {
+ strcat(displayLine1, "1");
+ }
+ else
+ {
+ strcat(displayLine1, "0");
+ }
- stopBtt.mode(PullUp);
- wait(.1);
- NVIC_SystemReset(); //reset system
- }
-}
+ strcat(displayLine1, ",Start=");
+ if(cycleStartBtt == 1)
+ {
+ strcat(displayLine1, "1 ");
+ }
+ else
+ {
+ strcat(displayLine1, "0 ");
+ }
-int main()
-{
-
- //on power up status
- cycleStartBtt.mode(PullUp);
- wait(.1);
-
- doorClosed.mode(PullUp);
- wait(.1);
-
- stopBtt.mode(PullUp);
- wait(.1);
- stopBtt.fall(&fullStop); // attach the address of the flip function to the rising edge
-
-
- //check for closed door before running fan
- while(doorClosed!=0)
- {
- rgbLCD.clear();
- rgbLCD.locate(0,0);
- rgbLCD.print("Close the door ");
- }
-
- //Display startup countdown
- //Startin up and prep the tank
- rgbLCD.clear();
- rgbLCD.setRGB(0x00, 0x66, 0xaa); //set the color
- rgbLCD.print("Starting up... ");
-
- vfd=0;
- damperRotate(1); //vent opened;
- doorInterlock=1;
- fanRelay=1;
- greenRelay=0;
- yellowRelay=0;
- redRelay=0;
-
- //start timer for 90sec
- countDown(5);
-
- //Tank is ready
- rgbLCD.locate(0,0);
- rgbLCD.print("Tank is ready! ");
- greenRelay=1; //green light on
-
- //doorInterlock=0; //interlock unlatched, ready to load material into the tank
- fanRelay=0; //fan off
-
- while(1)
- {
-
- if(doorClosed==0) //door closed
+
+ strcpy(displayLine2, "Stop= ");
+ if(stopBtt == 1)
+ {
+ strcat(displayLine2, "1 ");
+ }
+ else
{
- rgbLCD.locate(0,1);
- rgbLCD.print("Door closed ");
- greenRelay=1; //green light stays on
- yellowRelay=0; //yellow light off
- redRelay=0; //red light off
+ strcat(displayLine2, "0 ");
+ }
+
+ // Every 2s, change the outputs
+ if((count&7) == 0)
+ {
+ doorInterlock = OUT_OFF; //Door interlock
+ fanRelay = OUT_OFF; //Fan control
+ redRelay = OUT_OFF; //Red light
+ yellowRelay = OUT_OFF; //Yellow light
+ greenRelay = OUT_OFF; //Green light
+ damperRelay = OUT_OFF; //Damper solenoid control
+ damperRelayAlt = OUT_OFF; //Damper solenoid toggle control
+ vfd = OUT_OFF; //VFD Start relay
- doorInterlock=0; //door unlocked
- fanRelay=0;
-
-
- //cycle start button pressed - wash cycle starts
- if(cycleStartBtt==0)
+ switch((count>>3)%8)
{
-
- //Display status
- rgbLCD.clear();
- rgbLCD.locate(0,0);
- rgbLCD.print("CYCLE STARTED! ");
- greenRelay=0; //green light off
- yellowRelay=1; //yellow light on
- doorInterlock=1; //door locked
- fanRelay=0; //fan stop
- damperRotate(0); //vent close
- vfd=1; //vfd for pump up to speed
-
- //Display wash cycle countdown
- //start timer for 2min
- countDown(7);
-
- //finished washing
- vfd=0; //pump off
- //Display status
- rgbLCD.clear();
- rgbLCD.locate(0,0);
- rgbLCD.print("CYCLE FINISHED! ");
- countDown(5);
-
- //drip dry after washing
- //Display status
- rgbLCD.clear();
- rgbLCD.locate(0,0);
- rgbLCD.print("DRIP DRYING! ");
-
- //start timer for 5min
- countDown(10);
-
- //Display status
- rgbLCD.clear();
- rgbLCD.locate(0,0);
- rgbLCD.print("AIR CYCLING! ");
- damperRotate(1); //vent opened
- fanRelay=1; //fan on
-
- //Display air cycling countdown
- //start timer for 2min
- countDown(10);
-
- //finished cycling air
- greenRelay=1; //green light on
- yellowRelay=0; //yellow light off
- doorInterlock=0; //door unlocked
- fanRelay=0; //fan off
- damperRotate(0); //damperRelay=0; //vent closed
-
- //Tank is ready
- rgbLCD.clear();
- rgbLCD.locate(0,0);
- rgbLCD.print("Tank is ready! ");
+ case 0:
+ doorInterlock = OUT_ON; //Door interlock
+ strcat(displayLine2, " Lock ");
+ break;
+ case 1:
+ fanRelay = OUT_ON; //Fan control
+ strcat(displayLine2, " Fan ");
+ break;
+ case 2:
+ redRelay = OUT_ON; //Red light
+ strcat(displayLine2, " Red ");
+ break;
+ case 3:
+ yellowRelay = OUT_ON; //Yellow light
+ strcat(displayLine2, " Yellow ");
+ break;
+ case 4:
+ greenRelay = OUT_ON; //Green light
+ strcat(displayLine2, " Green ");
+ break;
+ case 5:
+ damperRelay = OUT_ON; //Damper solenoid control
+ strcat(displayLine2, " Damper1");
+ break;
+ case 6:
+ damperRelayAlt = OUT_ON; //Damper solenoid toggle control
+ strcat(displayLine2, " Damper2");
+ break;
+ case 7:
+// vfd = OUT_ON; //VFD Start relay
+ strcat(displayLine2, " ");
+ break;
}
- /*
- //Stop button is hit
- if(stopBtt==1)
- {
- //Display status
- rgbLCD.locate(0,0);
- rgbLCD.print("CYCLE STOPPED. ");
- vfd=0; //pump off
- doorInterlock=1; //door latched
- wait(2);
- fanRelay=0; //fan stops
- damperRotate(0); //damperRelay=0; //damper closed
-
- //wait 60sec
- countDown(10);
- doorInterlock=0; //door unlatched
- }
-*/
}
- else //door open
- {
- rgbLCD.locate(0,1);
- rgbLCD.print("Door opened ");
- greenRelay=0; //green light OFF
- redRelay=1; //turn red light ON
- yellowRelay=0;
- fanRelay=0; //fan stops
- damperRotate(1); //damperRelay=1; //damper closed
-
- }
-
- }
+
+ rgbLCD.locate(0,0);
+ rgbLCD.print(displayLine1);
+ rgbLCD.locate(0,1);
+ rgbLCD.print(displayLine2);
+
+ wait(.25);
+ count++;
+ }
+ while(cycleStartBtt == IN_OFF || stopBtt == IN_OFF || doorClosed == IN_OFF);
}
\ No newline at end of file