Part of the Pacemaker Project; this models the Pacemaker.
Dependencies: mbed TextLCD mbed-rtos
Diff: PacemakerController.cpp.orig
- Revision:
- 13:2a25dd47478e
--- /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(); + +}