Diff: main.cpp

Revision:

0:f1d65a71251b

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon May 05 16:25:36 2014 +0000
@@ -0,0 +1,53 @@
+#include "mbed.h"
+#include "TSISensor.h"
+
+Serial pc(USBTX, USBRX);
+PwmOut crvena(PTB18), zelena(PTB19), plava(PTD1);
+TSISensor touch_sensor;
+Ticker prikaz;
+
+void PrikaziNaTerminal()
+{
+    pc.printf("Procenat aktivacije %f\n", touch_sensor.readPercentage());
+}
+
+int get_digit(char c)
+{
+    return c - '0';
+}
+
+int main()
+{
+    int procenat = 0;
+
+    crvena = 1.;
+    zelena = 1.;
+    plava = 1.;
+
+    while(true)
+    {
+        char komanda = pc.getc();
+
+        if(komanda == 'R' || komanda == 'G' || komanda == 'B')
+        {
+            int desetice = get_digit(pc.getc());
+            int jedinice =  get_digit(pc.getc());
+            if(desetice < 0 || desetice > 9) continue;
+            if(jedinice < 0 || jedinice > 9) continue;
+
+                    procenat = desetice * 10 + jedinice;
+                    float ukljuci = 1. - procenat / 100.;
+                    crvena = 1.;
+                    zelena = 1.;
+                    plava = 1.;
+                    if(komanda == 'R') crvena = ukljuci;
+                    else if(komanda == 'G') zelena = ukljuci;
+                    else plava = ukljuci;
+
+        }
+        else if(komanda == 'P') prikaz.attach(PrikaziNaTerminal, 1.);
+        else if(komanda == 'Z') prikaz.detach();
+    }
+
+    return 0;
+}