PES 4 - Smart Medication Dispenser / PES4_ProgrammeforDesignReview2

Dependencies:   SDFileSystem mbed

Fork of PES4_Programme by PES 4 - Smart Medication Dispenser

Revision:
61:086bcd5ca968
Parent:
60:7554e4272b3b
Child:
69:ec1cfc0cd161
Child:
72:172b40dd16ee
--- a/source/main.cpp	Thu Apr 05 14:12:27 2018 +0000
+++ b/source/main.cpp	Thu Apr 05 18:07:35 2018 +0000
@@ -212,47 +212,65 @@
                 break;
             case 55:
                 /* Demo Tool */
-                summer.period_us(500);
-                summer.write(0.5f);
-                wait(3);
-                summer.write(0.0f);
+                enableOutput();
+                printf("Servo output enabled\r\n\n");
+                //summer.period_us(500);
+                //summer.write(0.5f);
+                //wait(3);
+                //summer.write(0.0f);
+
+                //userButton1.fall(&summ);
 
-                userButton1.fall(&summ);
+                color = 0xFFFFFF;
+                colorTime = 0;
 
-                color = 0x0055AA;
+                setLED(0,color);
+                wait(5);
+                printf("start loop\n\r");
                 while(colorTime < DEMOTIME) {
+                    printf("fade1\n\r");
                     for(r = 0; r <= 255; r++) {
                         color &= 0x00FFFF;
-                        color &= (r<<4);
+                        color |= (r<<16);
+                        printf("color = %d\n\r",color);
+                        setLED(0,color);
                         wait_ms(FADESPEED);
                     }
+                    printf("fade2");
                     for(b = 255; b >= 0; b--) {
                         color &= 0xFFFF00;
-                        color &= b;
+                        color |= b;
+                        setLED(0,color);
                         wait_ms(FADESPEED);
                     }
+                    printf("fade3");
                     for(g = 0; g <= 255; g++) {
                         color &= 0xFF00FF;
-                        color &= (g<<2);
+                        color |= (g<<8);
+                        setLED(0,color);
                         wait_ms(FADESPEED);
                     }
                     for(r = 255; r > 0; r--) {
                         color &= 0x00FFFF;
-                        color &= (r<<4);
+                        color |= (r<<16);
+                        setLED(0,color);
                         wait_ms(FADESPEED);
                     }
                     for(b = 0; b <= 255; b++) {
                         color &= 0xFFFF00;
-                        color &= b;
+                        color |= b;
+                        setLED(0,color);
                         wait_ms(FADESPEED);
                     }
                     for (g = 255; g > 0; g--) {
                         color &= 0xFF00FF;
-                        color &= (g<<2);
+                        color |= (g<<8);
+                        setLED(0,color);
                         wait_ms(FADESPEED);
                     }
                     colorTime++;
                 }
+                printf("exit demo");
 
                 break;
             default: