Diff: main.cpp

Revision:

6:bd874c16ce2f

Parent:

3:32a940251192

diff -r 9817756efc34 -r bd874c16ce2f main.cpp
--- a/main.cpp	Tue Feb 27 10:29:30 2018 +0000
+++ b/main.cpp	Fri Mar 09 18:46:54 2018 +0000
@@ -1,100 +1,140 @@
 #include "mbed.h"
 #include "rtos.h"
 #include "wdt.h"
-
 // Sample program using the Watchdog
 // ---------------------------------
 //    * Three threads co-operate to flash two LEDs
-//    * A simple way to inject a fault, by pressing a button 
+//    * A simple way to inject a fault, by pressing a button
 //    * The watchdog is configured with a 32ms timeout
-
 #define ON 1
 #define OFF 0
 DigitalOut led_red(LED_RED, ON);
 DigitalIn button(PTD0, PullUp);
 DigitalOut led1(PTC12, OFF);
 DigitalOut led2(PTC13, OFF);
-
+Serial pc(USBTX, USBRX);
 // This ticker is used to feed the watch dog
 Ticker tick;
-
 // Threads
-Thread threadT ; // timer thread 
-Thread threadLED1 ; // thread LED1
-Thread threadLED2 ; // thread LED2
+Thread threadT(osPriorityNormal,1000); // timer thread
+Thread threadLED1(osPriorityNormal,1000); // thread LED1
+Thread threaddetection(osPriorityNormal,1000);
+//define the state of watch dog
+enum wState {Working, Stopped} ;
+wState watchdogflag;
+AnalogIn ainled1(A0); //LED1 ADC INPUT
+float volt1,volt2;
 
 // ------------Fault Injection Button-------------
 //  Wait while the button is down
 //     Use this to simulate a STUCK fault
 // -----------------------------------------------
-void waitButton() {
-    while (!button) ;  
-}
+void waitButton()
+{
 
+    while (!button) {
+        //pc.printf("stop watchdog");
+        watchdogflag=Stopped;
+    }
+}
 // ---Thread for controlling LED 1----------------
-//   Turn LED1 on/off in response to signals 
+//   Turn LED1 on/off in response to signals
 // -----------------------------------------------
-void led1_thread() {  // method to run in thread
+void led1_thread()    // method to run in thread
+{
     osEvent evt ;
     while (true) {
         evt = Thread::signal_wait(0x0); // wait for any signal
         if (evt.status == osEventSignal) {
-            if (evt.value.signals & 0x01) led1 = ON ;
+            if (evt.value.signals & 0x01) {
+                led1 = ON ;
+            }
             if (evt.value.signals & 0x02) led1 = OFF ;
-        } 
-        waitButton() ;  // POSSIBLE FAULT HERE
+        }
     }
 }
-
 // ---Thread for controlling LED 2----------------
-//   Turn LED2 on/off in response to signals 
+//   Turn LED2 on/off in response to signals
 // -----------------------------------------------
-void led2_thread() {  // method to run in thread
+void led2_thread()    // method to run in thread
+{
     osEvent evt ;
     while (true) {
         evt = Thread::signal_wait(0x0); // wait for any signal
         if (evt.status == osEventSignal) {
-            if (evt.value.signals & 0x01) led2 = ON ;
+            if (evt.value.signals & 0x01) {
+                led2 = ON ;
+            }
             if (evt.value.signals & 0x02) led2 = OFF ;
-        } 
+        }
         // waitButton() ; // POSSIBLE FAULT HERE
     }
 }
-
 // ---Thread for timing --------------------------
 //   Send signals to the other threads
 // -----------------------------------------------
-void timer_thread() {  // method to run in thread
+void timer_thread()    // method to run in thread
+{
     while (true) {
         Thread::wait(250) ;
-        threadLED1.signal_set(0x1) ;
-        threadLED2.signal_set(0x1) ;
+        threadLED1.signal_set(0x1) ;//on
         Thread::wait(250) ;
-        threadLED1.signal_set(0x2) ;
-        threadLED2.signal_set(0x2) ;
+        threadLED1.signal_set(0x2) ;//off
         // waitButton() ; // POSSIBLE FAULT HERE
     }
 }
+void detection_thread()
+{
+    int counter=0;
+    while (1) {
+        volt1 = ainled1;
+        if (volt1>0.90) {
+            led_red=0;
+        } else {
+            if(led1==1) {
+                if ((volt1<0.1)) {
+                    counter++;
+                    if (counter>5) {
+                        if(led_red==1)led_red=0;
+                        counter =0;
+                    }
+                } else {
+                    if (led_red==0)led_red=1;
+                }
+            }
+        }
+        waitButton(); // POSSIBLE FAULT HERE
+    }
+}
+// -----------MAIN-------------------------------
+//    Configure watchdog. Start threads.
+//    Show start up with RED for 1sec
+//    Remember the watchdog is running
+//       - 1024ms to set it once
+//       - then must feed it every 32ms
+// ----------------------------------------------
+void watchdog()
+{
+    if (watchdogflag==Working) {
+        wdt_kick_all();
+    }
+}
 
-// -----------MAIN-------------------------------
-//    Configure watchdog. Start threads. 
-//    Show start up with RED for 1sec
-//    Remember the watchdog is running
-//       - 1024ms to set it once
-//       - then must feed it every 32ms  
-// ----------------------------------------------
+int main(void)
+{
 
-int main(void) {
     wdt_32ms() ; // initialise watchdog - 32ms timeout
-    tick.attach_us(callback(&wdt_kick_all), 20000); // ticks every 20ms    
-    
+    watchdogflag = Working;
+    tick.attach_us(callback(&watchdog), 20000);
+
     // start threads
-    threadT.start(&timer_thread) ; // start the timer thread 
-    threadLED1.start(&led1_thread) ; // start the LED1 control thread 
-    threadLED2.start(&led2_thread) ; // start the LED2 control thread 
-    
+    threadT.start(&timer_thread) ; // start the timer thread
+    threadLED1.start(&led1_thread) ; // start the LED1 control thread
+    threaddetection.start(&detection_thread);
+
     // show start-up
     led_red = OFF;
-    Thread::wait(1000) ;
+    Thread::wait(1000) ;//1ms
     led_red = ON;
-}
\ No newline at end of file
+
+}