Diff: PacemakerController.cpp.orig

Revision:

13:2a25dd47478e

diff -r ed162e1f7194 -r 2a25dd47478e PacemakerController.cpp.orig
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/PacemakerController.cpp.orig	Mon Nov 30 20:53:55 2015 +0000
@@ -0,0 +1,219 @@
+#include "mbed.h"
+#include "LPC17xx.h"
+#include "TextLCD.h"
+#include "rtos.h"
+#include "Thread.h"
+using namespace rtos;
+
+ 
+// This is for the pacemaker
+volatile unsigned short timer_count;
+Serial pc(USBTX, USBRX);
+TextLCD lcd(p15, p16, p17, p18, p19, p20, TextLCD::LCD20x4); // rs, e, d4-d7
+
+int keyboard_needs_numeric = 0; // boolean - is in middle of interval input?
+
+int h_clock;
+int pm_clock;
+int avi_clock; 
+
+int LRI = 1000;
+int AVI = 150;
+int PVARP = 300;
+int VRP = 200;
+
+// constants
+int MAX_PM_RT = 180;
+int MIN_PM_RT = 40;
+enum mode {NORMAL, SLEEP, EXERCISE, MANUAL};
+
+// counters
+int beats = 0;
+
+// state variables
+int upper_bound = 100;
+int lower_bound = 40;
+int obs_int = 10;
+mode curr_mode = NORMAL;
+
+
+
+// alarms 
+DigitalOut Apace(LED1);
+DigitalOut Vpace(LED2);
+DigitalOut Asense(LED3);
+DigitalOut Vsense(LED4);
+DigitalOut apace(p22):
+DigitalOut vpace(p21):
+
+// hardware interrupt handler, adapted from code in piazza post by Dagaen
+extern "C" void TIMER0_IRQHandler (void)
+{
+if((LPC_TIM0->IR & 0x01) == 0x01)   // if MR0 interrupt, proceed
+    {
+    LPC_TIM0->IR |= 1 << 0;         // Clear MR0 interrupt flag
+    timer_count++;                  //increment timer_count
+    }
+}
+ 
+// init the hardware interrupt (timer0), adapted same as above
+void timer0_init(void)
+{
+    LPC_SC->PCONP |=1<1;            //timer0 power on
+    LPC_SC-> PCLKSEL0 |= 1 << 2;    // set timer clock to CCLCK nondivided (1 clock cycle = 1 increment)
+    LPC_TIM0->MR0 = 1000000;          //100mhz clock cycle, 1 cycle = 10ns, 10ms = 10 000 000 ns = 1M cycles
+    LPC_TIM0->MCR = 3;              //interrupt and reset control
+                                    //3 = Interrupt & reset timer0 on match (111) sets all three bits
+    NVIC_EnableIRQ(TIMER0_IRQn);    //enable timer0 interrupt
+}
+
+
+void PM_ALARM(void const *argument){
+    
+    // min hr alarm
+    if( beats < MIN_PM_RT){
+        lcd.locate(0,1);
+        lcd.printf("!<"); 
+    }
+      
+    // max hr alarm
+    if(beats > MAX_PM_RT){
+        lcd.locate(0,1);
+        lcd.printf("!>"); 
+    }  
+    
+}
+
+// hw interrupt callback, deal with the keyboard input from PC
+void keyboard_handler() {
+    
+    // get the char, put it on the PC command line
+    char a = pc.getc();
+
+    if (keyboard_needs_numeric) {
+        if (a >= '0' && a <= '9') {
+            // update observation interval
+            obs_int = (a - '0' + 1) * 5;
+        } else {
+            pc.printf("Expected numeric key\n");    
+        }
+    } else if(a == 'N'){
+        // if the char is N, update bounds to normal mode
+        curr_mode = NORMAL;
+        upper_bound = 100;
+        lower_bound = 40;
+        pc.printf("MODE IS N\n");  
+    // if the char is S, set bounds to sleep
+    }else if (a == 'S'){
+        curr_mode = SLEEP;
+        upper_bound = 60;
+        lower_bound = 30;
+        pc.printf("MODE IS S\n");  
+    // if the char is E, set bounds to exercise
+    }else if (a == 'E'){
+        curr_mode = EXERCISE;
+        upper_bound = 175;
+        lower_bound = 100;
+        pc.printf("MODE IS E\n");  
+        beats = 2;
+    // if the char is M, set to manual
+    }else if (a == 'M'){
+        curr_mode = MANUAL;
+        upper_bound = 175;
+        lower_bound = 30;
+        beats = 300;
+        pc.printf("MODE IS MANUAL\n");  
+    // check for A if mode is manual
+    }else if (a == 'A'){
+        if(curr_mode == MANUAL){
+            pc.printf("MODE IS MANUAL GOT APACE\n");  
+        }
+    // check for V is mode is manual  
+    }else if (a == 'V'){
+        if(curr_mode == MANUAL){
+            pc.printf("MODE IS MANUAL GOT VPACE\n");   
+        }  
+    }else if (a == 'O'){
+        keyboard_needs_numeric = 1;
+    } else{
+        // do nothing for invalid char
+    }
+    
+    
+}
+
+void pm_sense() {
+    
+    while(1) {
+        
+        if (timer_count >= VRP) {
+              //wait for Vget;
+              timer_count = 0;
+              // do something with Vsense!
+        } else if (timer_count < VRP) {
+            // wait for Vget
+        }
+        
+        if (timer_count < PVARP) {
+            // wait for Aget?
+        } else if (timer_count >= PVARP) {
+            // wait for Aget?
+            // do something with Asense!
+        }
+        
+    }
+}
+
+void pm_response() {
+ 
+    while(1) {
+         if (timer_count >= LRI-AVI) {
+             // PM_A!
+             // avi_clk = 0
+             //apace();
+         } else if (timer_count < LRI - AVI) {
+             // avi_clk = 0
+             // wait for Asense?
+         } 
+         
+         // At Atrial Event State
+         
+         //while (avi_clk < AVI);
+         
+         // Ventricular Event
+         timer_count = 0;
+         // PM_V!
+         timer_count = 0;
+         // VPace!
+         
+        
+    } 
+}
+
+
+void apace() {
+    apace = 1;
+    Thread::wait(10);
+    apace = 0;
+    
+}
+
+void vpace() {
+    vpace = 1;
+    Thread::wait(10);
+    vpace = 0;
+}
+
+
+int main() {
+    https://developer.mbed.org/users/chadnach1/code/PacemakerController/
+    // connect the serial device (PC keybd) to the interrupt
+    pc.attach(&keyboard_handler);
+    
+    Thread t3(pm_sense);
+    Thread t4(pm_response);
+
+    Thread t2(PM_ALARM);
+    Thread t5();
+
+}