udpated n,e,s modeswitch

Dependencies:   TextLCD mbed-rtos mbed

Fork of pacemaker_v5 by Pacemaker

Revision:
3:39870b37d0c4
Parent:
2:4ce21a8fc0d5
Child:
4:4572cbbb6c15
diff -r 4ce21a8fc0d5 -r 39870b37d0c4 main.cpp
--- a/main.cpp	Wed Dec 03 23:28:06 2014 +0000
+++ b/main.cpp	Wed Dec 03 23:33:38 2014 +0000
@@ -229,11 +229,22 @@
             status_mutex.lock();
             if (!isVRP && waitingForV){
                 t_mutex.lock();
-                blind();
+                tv.start();
+                ta.reset();
+                ta.stop();
+                
+                isVRP = 1;
+                isPVARP = 1;
+                waitingForV = 0;
+                
+                VRP_timer->start(VRP);
+                PVARP_timer->start(PVARP);
+                beats++;
+                
                 flashLED(3);
                 t_mutex.unlock();
-                status_mutex.unlock();
             }
+            status_mutex.unlock();
             while(VGet == 1);
         }
     }