Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FXOS8700Q FastPWM

Revision:
3:46c11151e0fd
Parent:
2:626688c21b6f
Child:
4:f988679bf9a1
--- a/main.cpp	Tue Sep 10 13:22:03 2019 +0000
+++ b/main.cpp	Wed Sep 11 09:38:22 2019 +0000
@@ -11,65 +11,45 @@
 DigitalOut ledgreen(LED_GREEN);
 
 MODSERIAL pc(USBTX, USBRX);
+Ticker Theticker;
+volatile char c='x';
+void Take_Measurement(void)
+{
+    if (c=='r')
+    {
+        ledred=!ledred;
+    }
+    else if (c=='g')
+    {
+        ledgreen=!ledgreen;
+    }
+    else if (c=='b')
+    {
+        ledblue=!ledblue;
+    }
+    else
+    {
+        ledred=1;
+        ledgreen=1;
+        ledblue=1;
+    }
+}
 
 int main()
 {
-    char c;
-    c='x';
-    int color;
+    ledred=1;
+    ledgreen=1;
+    ledblue=1;
+    Theticker.attach(Take_Measurement,0.05);
+    int countr;
     pc.baud(115200);
     pc.printf("\r\nStarting...\r\n\r\n");
-    pc.printf("Hello world!");
-    
+    pc.printf("Enter the color that has to blink:\r\n");
+    c=pc.getc();
+    pc.printf("Color picked: '%c'\r\nNow counting so the system does something:\r\n",c);
     while (true) {
         color+=1;
-        ledred!=ledred;
-        if (color%2==0)
-        {
-        ledgreen=!ledgreen;
-        }
-        if (color%4==0)
-        {
-        ledblue=!ledblue;
-        }
-        if (color%8==0)
-        {
-        if (c=='g')
-        {
-            DigitalOut ledred(LED_RED);
-            ledred=!ledred;
-            DigitalOut ledblue(LED_BLUE);
-            ledblue=!ledblue;
-            DigitalOut ledgreen(LED_GREEN);
-        }
-        else if (c=='b')
-        {
-            DigitalOut ledred(LED_RED);
-            ledred=!ledred;
-            DigitalOut ledblue(LED_BLUE);
-            DigitalOut ledgreen(LED_GREEN);
-            ledgreen=!ledgreen;
-        }
-        else if (c=='r')
-        {
-            DigitalOut ledred(LED_RED);
-            DigitalOut ledblue(LED_BLUE);
-            ledblue=!ledblue;
-            DigitalOut ledgreen(LED_GREEN);
-            ledgreen=!ledgreen;
-        }
-        else
-        {
-            DigitalOut ledred(LED_RED);
-            ledred=!ledred;
-            DigitalOut ledblue(LED_BLUE);
-            ledblue=!ledblue;
-            DigitalOut ledgreen(LED_GREEN);
-            ledgreen=!ledgreen;
-        }
-        c=pc.getc();
-        pc.putc(c);
-        }
+        pc.printf("%i\r\n",countr);
         wait_ms(500);
     }
 }