Diff: main.cpp

Revision:

5:dad93c5af6f6

Parent:

4:d54e74fbf82c

--- a/main.cpp	Thu Feb 22 16:59:24 2018 +0000
+++ b/main.cpp	Thu Mar 01 18:59:53 2018 +0000
@@ -10,17 +10,19 @@
 Serial pc(USBTX, USBRX); // tx, rx
 DigitalOut redLED(LED_RED);
 DigitalOut greenLED(LED_GREEN);
+DigitalOut blueLED (LED_BLUE);
+DigitalOut led1(D0);
 TSISensor tsi;
 
 Thread redThread ; // thread for red LED
 Thread greenThread ; // thread for green LED
+Thread blueThread ;
+Thread orangeThread ;
  
 void red_thread() {  // method to run in thread
     while (true) {
         Thread::signal_wait(0x1);
-        redLED = false ; // turn on 
-        Thread::wait(5000);
-        redLED = true ; // turn off 
+        redLED = !redLED ; // turn on 
         redThread.signal_clr(0x1) ;
           // Signal are automatically cleared by wait_signal but
           // the signal might have been set again while LED on 
@@ -30,20 +32,45 @@
 void green_thread() {  // method to run in thread
     while (true) {
         Thread::signal_wait(0x1);
-        greenLED = false ; // turn on 
-        Thread::wait(5000);
-        greenLED = true ; // turn off 
+        greenLED = !greenLED ; // turn on 
         greenThread.signal_clr(0x1) ;
           // Signal are automatically cleared by wait_signal but
           // the signal might have been set again while LED on 
     }
 }
 
+void blue_thread() {  // method to run in thread
+    while (true) {
+        Thread::signal_wait(0x1);
+        blueLED = !blueLED ; // turn on        
+        blueThread.signal_clr(0x1) ;
+          // Signal are automatically cleared by wait_signal but
+          // the signal might have been set again while LED on 
+    }
+}
+
+void orange_thread() {  // method to run in thread
+    while (true) {
+        
+        led1 = true;
+        Thread::signal_wait(0x1);
+        led1 = !led1 ; // turn on 
+        orangeThread.signal_clr(0x1) ;
+          // Signal are automatically cleared by wait_signal but
+          // the signal might have been set again while LED on 
+    }
+}
+
+
 int main(void) {
     redLED = true ; // turn off 
     greenLED = true ; // turn off 
+    blueLED = true ;
+    led1 = true ;
     redThread.start(&red_thread) ; // start the red thread
     greenThread.start(&green_thread) ; // start the green thread
+    blueThread.start(&blue_thread) ;
+    orangeThread.start(&orange_thread);
     
     while (true) {
         uint8_t d = tsi.readDistance() ;  // Distance is between 0 and 39
@@ -51,9 +78,15 @@
                                           // Left --> low value  Right --> high value
         pc.printf("%d", d) ;  
         pc.putc(' ') ;
-        if (d == 10) redThread.signal_set(0x1) ;
-        if (d == 20) greenThread.signal_set(0x1) ;
+        if (d > 3 && d < 9) redThread.signal_set(0x1) ;
+        
+        if (d > 13 && d < 19) greenThread.signal_set(0x1) ;
+        
+        if (d > 23 && d < 29) blueThread.signal_set(0x1) ;
+        
+        if (d > 30 && d < 39) orangeThread.signal_set(0x1) ;
+        
         Thread::wait(200);  // This polling rate is too slow - increase it
                             // The slower rate maks it easier to output on the terminal
     }
-}
\ No newline at end of file
+}