IDT Optical Sensors / Mbed 2 deprecated OB1203_IDT

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed OB1203_example_driver

main.cpp@13:5ce84c68066e, 2018-06-26 (annotated)

Committer:
laserdad
Date:
Tue Jun 26 11:40:27 2018 +0000
Revision:
13:5ce84c68066e
Parent:
12:5de5f550e765
Child:
14:ae0be10b73cd
added AGC

Who changed what in which revision?

UserRevisionLine numberNew contents of line
laserdad 0:e9ae48b7f6f6 1 #include "mbed.h"
laserdad 0:e9ae48b7f6f6 2 #include "OB1203.h"
laserdad 0:e9ae48b7f6f6 3 #include "math.h"
laserdad 4:3aee2ca931b8 4 //#include "SoftI2C.h"
laserdad 0:e9ae48b7f6f6 5
laserdad 0:e9ae48b7f6f6 6 #define intb_pin D3
laserdad 0:e9ae48b7f6f6 7
laserdad 0:e9ae48b7f6f6 8 I2C i2c(I2C_SDA,I2C_SCL);
laserdad 13:5ce84c68066e 9 //I2C i2c(PA_4,PA_7);
laserdad 4:3aee2ca931b8 10 //SoftI2C i2c(I2C_SDA,I2C_SCL);
laserdad 0:e9ae48b7f6f6 11 InterruptIn intb(intb_pin);
laserdad 10:7fbf298ee05f 12 DigitalOut sda_pullup(D10,1);
laserdad 10:7fbf298ee05f 13 DigitalOut scl_pullup(D11,1);
laserdad 10:7fbf298ee05f 14 DigitalOut intb_pullup(D12,1);
laserdad 0:e9ae48b7f6f6 15
laserdad 13:5ce84c68066e 16 //InterruptIn intb(D10);
laserdad 13:5ce84c68066e 17 //DigitalOut sda_pullup(D13,1);
laserdad 13:5ce84c68066e 18 //DigitalOut scl_pullup(PA_0,1);
laserdad 13:5ce84c68066e 19 //DigitalOut intb_pullup(PA_4,1);
laserdad 13:5ce84c68066e 20
laserdad 0:e9ae48b7f6f6 21 OB1203 ob1203(&i2c);
laserdad 2:ee175f471ecb 22 Serial pc(USBTX, USBRX,256000);
laserdad 0:e9ae48b7f6f6 23 Timer t;
laserdad 0:e9ae48b7f6f6 24
laserdad 1:fb6b2b4d5d8a 25
laserdad 6:aaa2f8fb5123 26 //USER CONFIGURABLE*********
laserdad 7:3ed0f0522b43 27 bool mode = 1; //0 for PS_LS, 1 for PPG
laserdad 7:3ed0f0522b43 28 bool meas_ps = 1;
laserdad 12:5de5f550e765 29 bool spo2 = 1; //0 for HR, 1 for SpO2
laserdad 4:3aee2ca931b8 30 bool afull = 1; //use Afull interrupt--otherwise PPG new data interrupt
laserdad 12:5de5f550e765 31 bool meas_temp = 1;
laserdad 13:5ce84c68066e 32 bool printAvg = 0; //default 0 print raw data
laserdad 13:5ce84c68066e 33 bool redAGC = 1;
laserdad 13:5ce84c68066e 34 bool IRAGC = 1;
laserdad 6:aaa2f8fb5123 35 //****************************
laserdad 6:aaa2f8fb5123 36
laserdad 6:aaa2f8fb5123 37 //internal settings
laserdad 6:aaa2f8fb5123 38 bool intFlagged =0;
laserdad 6:aaa2f8fb5123 39 int sample_delay = 25; //ms
laserdad 1:fb6b2b4d5d8a 40
laserdad 0:e9ae48b7f6f6 41 void defaultConfig()
laserdad 0:e9ae48b7f6f6 42 {
laserdad 13:5ce84c68066e 43 ob1203.osc_trim = 0x00; //max trim code =0x3F
laserdad 9:98b9216f9ff3 44
laserdad 4:3aee2ca931b8 45 meas_temp ? ob1203.temp_en = TEMP_ON : ob1203.temp_en = TEMP_OFF;
laserdad 4:3aee2ca931b8 46
laserdad 12:5de5f550e765 47 ob1203.ls_res = LS_RES(2); //2= 18bit 100ms, 0= max res
laserdad 12:5de5f550e765 48 ob1203.ls_rate = LS_RATE(2); //2 =100ms, 4 = 500ms
laserdad 4:3aee2ca931b8 49 ob1203.ls_gain = LS_GAIN(3); //gain 3 default (range)
laserdad 1:fb6b2b4d5d8a 50 ob1203.ls_thres_hi = 0x000FFFFF;
laserdad 0:e9ae48b7f6f6 51 ob1203.ls_thres_lo = 0;
laserdad 0:e9ae48b7f6f6 52 ob1203.ls_sai = LS_SAI_OFF;
laserdad 0:e9ae48b7f6f6 53 ob1203.ls_mode = RGB_MODE;
laserdad 0:e9ae48b7f6f6 54 ob1203.ls_en = LS_ON;
laserdad 4:3aee2ca931b8 55
laserdad 0:e9ae48b7f6f6 56 ob1203.ps_sai_en = PS_SAI_OFF;
laserdad 5:ebe305e08430 57 // ob1203.ps_sai_en = PS_SAI_ON;
laserdad 1:fb6b2b4d5d8a 58 if(mode)
laserdad 1:fb6b2b4d5d8a 59 {
laserdad 3:d3a1fc19bee6 60 if (spo2)
laserdad 3:d3a1fc19bee6 61 {
laserdad 3:d3a1fc19bee6 62 ob1203.ppg_ps_mode = SPO2_MODE;
laserdad 3:d3a1fc19bee6 63 }
laserdad 3:d3a1fc19bee6 64 else
laserdad 3:d3a1fc19bee6 65 {
laserdad 3:d3a1fc19bee6 66 ob1203.ppg_ps_mode = HR_MODE;
laserdad 3:d3a1fc19bee6 67 }
laserdad 3:d3a1fc19bee6 68
laserdad 1:fb6b2b4d5d8a 69 }
laserdad 1:fb6b2b4d5d8a 70 else
laserdad 1:fb6b2b4d5d8a 71 {
laserdad 1:fb6b2b4d5d8a 72 ob1203.ppg_ps_mode = PS_MODE;
laserdad 1:fb6b2b4d5d8a 73 }
laserdad 12:5de5f550e765 74 ob1203.ps_pulses = PS_PULSES(3);
laserdad 1:fb6b2b4d5d8a 75 // pc.printf("ps_pulses = %02X\r\n",ob1203.ps_pulses);
laserdad 7:3ed0f0522b43 76 ob1203.ps_pwidth = PS_PWIDTH(1);
laserdad 7:3ed0f0522b43 77 ob1203.ps_rate = PS_RATE(4);
laserdad 1:fb6b2b4d5d8a 78 // pc.printf("ps_rate = %02X\r\n",ob1203.ps_rate);
laserdad 12:5de5f550e765 79 ob1203.ps_avg_en = PS_AVG_OFF;
laserdad 0:e9ae48b7f6f6 80 ob1203.ps_can_ana = PS_CAN_ANA_0;
laserdad 0:e9ae48b7f6f6 81 ob1203.ps_digital_can = 0;
laserdad 0:e9ae48b7f6f6 82 ob1203.ps_hys_level = 0;
laserdad 4:3aee2ca931b8 83 meas_ps ? ob1203.ps_current = 0x3FF : ob1203.ps_current = 0x000;
laserdad 4:3aee2ca931b8 84 // ob1203.ps_current = 0;
laserdad 0:e9ae48b7f6f6 85 ob1203.ps_thres_hi = 0xFF;
laserdad 0:e9ae48b7f6f6 86 ob1203.ps_thres_lo = 0x00;
laserdad 0:e9ae48b7f6f6 87
laserdad 0:e9ae48b7f6f6 88 //interrupts
laserdad 0:e9ae48b7f6f6 89 ob1203.ls_int_sel = LS_INT_SEL_W;
laserdad 0:e9ae48b7f6f6 90 ob1203.ls_var_mode = LS_THRES_INT_MODE;
laserdad 0:e9ae48b7f6f6 91 ob1203.ls_int_en = LS_INT_ON;
laserdad 0:e9ae48b7f6f6 92 ob1203.ppg_ps_en = PPG_PS_ON;
laserdad 4:3aee2ca931b8 93
laserdad 0:e9ae48b7f6f6 94 ob1203.ps_logic_mode = PS_INT_READ_CLEARS;
laserdad 0:e9ae48b7f6f6 95 ob1203.ps_int_en = PS_INT_ON;
laserdad 0:e9ae48b7f6f6 96 ob1203.ls_persist = LS_PERSIST(2);
laserdad 0:e9ae48b7f6f6 97 ob1203.ps_persist = PS_PERSIST(2);
laserdad 11:640cced1ee5d 98
laserdad 11:640cced1ee5d 99
laserdad 11:640cced1ee5d 100 //BIO SETTINGS
laserdad 4:3aee2ca931b8 101 //int
laserdad 4:3aee2ca931b8 102 if(afull)
laserdad 4:3aee2ca931b8 103 {
laserdad 4:3aee2ca931b8 104 ob1203.afull_int_en = AFULL_INT_ON;
laserdad 4:3aee2ca931b8 105 ob1203.ppg_int_en = PPG_INT_OFF;
laserdad 4:3aee2ca931b8 106 }
laserdad 4:3aee2ca931b8 107 else
laserdad 4:3aee2ca931b8 108 {
laserdad 4:3aee2ca931b8 109 ob1203.afull_int_en = AFULL_INT_OFF;
laserdad 4:3aee2ca931b8 110 ob1203.ppg_int_en = PPG_INT_ON;
laserdad 4:3aee2ca931b8 111 }
laserdad 0:e9ae48b7f6f6 112 //PPG
laserdad 13:5ce84c68066e 113 ob1203.ir_current = 0x1AF; //max 1023. 3FF
laserdad 3:d3a1fc19bee6 114 if (spo2)
laserdad 3:d3a1fc19bee6 115 {
laserdad 4:3aee2ca931b8 116 // ob1203.r_current = 0x0FF;
laserdad 13:5ce84c68066e 117 ob1203.r_current = 0x1AF; //max 511. 1FF
laserdad 3:d3a1fc19bee6 118 }
laserdad 3:d3a1fc19bee6 119 else
laserdad 3:d3a1fc19bee6 120 {
laserdad 3:d3a1fc19bee6 121 ob1203.r_current = 0;
laserdad 3:d3a1fc19bee6 122 }
laserdad 10:7fbf298ee05f 123 ob1203.ppg_ps_gain = PPG_PS_GAIN_1;
laserdad 0:e9ae48b7f6f6 124 ob1203.ppg_pow_save = PPG_POW_SAVE_OFF;
laserdad 0:e9ae48b7f6f6 125 ob1203.led_flip = LED_FLIP_OFF;
laserdad 11:640cced1ee5d 126 ob1203.ch1_can_ana = PPG_CH1_CAN(0);
laserdad 11:640cced1ee5d 127 ob1203.ch2_can_ana = PPG_CH2_CAN(0);
laserdad 12:5de5f550e765 128 ob1203.ppg_avg = PPG_AVG(4); //2^n
laserdad 12:5de5f550e765 129 ob1203.ppg_rate = PPG_RATE(1);
laserdad 12:5de5f550e765 130 ob1203.ppg_pwidth = PPG_PWIDTH(3);
laserdad 12:5de5f550e765 131 ob1203.ppg_freq = PPG_FREQ_50HZ;
laserdad 12:5de5f550e765 132 // ob1203.ppg_freq = PPG_FREQ_60HZ;
laserdad 10:7fbf298ee05f 133 ob1203.bio_trim = 3; //max 3
laserdad 10:7fbf298ee05f 134 ob1203.led_trim = 0x00; //max current
laserdad 10:7fbf298ee05f 135 ob1203.ppg_LED_settling = PPG_LED_SETTLING(2);
laserdad 9:98b9216f9ff3 136 ob1203.ppg_ALC_track = PPG_ALC_TRACK(2);
laserdad 11:640cced1ee5d 137 ob1203.diff = DIFF_ON;
laserdad 11:640cced1ee5d 138 ob1203.alc = ALC_ON;
laserdad 11:640cced1ee5d 139 ob1203.sig_out = SIGNAL_OUT;
laserdad 9:98b9216f9ff3 140
laserdad 2:ee175f471ecb 141 // ob1203.ppg_freq = PPG_FREQ_50HZ;
laserdad 3:d3a1fc19bee6 142
laserdad 0:e9ae48b7f6f6 143 ob1203.fifo_rollover_en = FIFO_ROLL_ON;
laserdad 13:5ce84c68066e 144 ob1203.fifo_afull_advance_warning = AFULL_ADVANCE_WARNING(0x0F); //warn as quickly as possible (after 17 samples with 0x0F)
laserdad 13:5ce84c68066e 145
laserdad 0:e9ae48b7f6f6 146 if(mode)
laserdad 0:e9ae48b7f6f6 147 {
laserdad 3:d3a1fc19bee6 148 if(spo2)
laserdad 3:d3a1fc19bee6 149 {
laserdad 3:d3a1fc19bee6 150 ob1203.init_spo2();
laserdad 3:d3a1fc19bee6 151 }
laserdad 3:d3a1fc19bee6 152 else
laserdad 3:d3a1fc19bee6 153 {
laserdad 3:d3a1fc19bee6 154 ob1203.init_hr();
laserdad 3:d3a1fc19bee6 155 }
laserdad 0:e9ae48b7f6f6 156 }
laserdad 0:e9ae48b7f6f6 157 else
laserdad 0:e9ae48b7f6f6 158 {
laserdad 5:ebe305e08430 159 meas_ps ? ob1203.init_ps_rgb() : ob1203.init_rgb();
laserdad 0:e9ae48b7f6f6 160 }
laserdad 0:e9ae48b7f6f6 161 }
laserdad 0:e9ae48b7f6f6 162
laserdad 1:fb6b2b4d5d8a 163 void regDump(uint8_t Addr, uint8_t startByte, uint8_t endByte)
laserdad 1:fb6b2b4d5d8a 164 {
laserdad 1:fb6b2b4d5d8a 165 /*print the values of up to 20 registers--buffer limit, e.g.*/
laserdad 1:fb6b2b4d5d8a 166 char regData[20];
laserdad 1:fb6b2b4d5d8a 167 int numBytes;
laserdad 1:fb6b2b4d5d8a 168 if (endByte>=startByte) {
laserdad 1:fb6b2b4d5d8a 169 numBytes = (endByte-startByte+1) < 20 ? (endByte-startByte+1) : 20;
laserdad 1:fb6b2b4d5d8a 170 } else {
laserdad 1:fb6b2b4d5d8a 171 numBytes=1;
laserdad 1:fb6b2b4d5d8a 172 }
laserdad 1:fb6b2b4d5d8a 173
laserdad 1:fb6b2b4d5d8a 174 regData[0] = startByte;
laserdad 1:fb6b2b4d5d8a 175 i2c.write(Addr,regData,1,true);
laserdad 1:fb6b2b4d5d8a 176 i2c.read(Addr, regData, numBytes);
laserdad 1:fb6b2b4d5d8a 177 for(int n=0; n<numBytes; n++) {
laserdad 1:fb6b2b4d5d8a 178 pc.printf("%02X, %02X \r\n", startByte+n, regData[n]);
laserdad 1:fb6b2b4d5d8a 179 }
laserdad 1:fb6b2b4d5d8a 180 }
laserdad 1:fb6b2b4d5d8a 181
laserdad 0:e9ae48b7f6f6 182
laserdad 0:e9ae48b7f6f6 183 void intEvent(void)
laserdad 0:e9ae48b7f6f6 184 {
laserdad 0:e9ae48b7f6f6 185 intFlagged = 1;
laserdad 0:e9ae48b7f6f6 186 }
laserdad 0:e9ae48b7f6f6 187
laserdad 0:e9ae48b7f6f6 188 int main()
laserdad 0:e9ae48b7f6f6 189 {
laserdad 4:3aee2ca931b8 190 int numInts = 0;
laserdad 10:7fbf298ee05f 191 uint32_t running_avg = 10;
laserdad 10:7fbf298ee05f 192 uint32_t ps_running_avg = 100;
laserdad 7:3ed0f0522b43 193 uint32_t ps_avg_ptr = 0;
laserdad 3:d3a1fc19bee6 194 char avg_ptr = 0;
laserdad 4:3aee2ca931b8 195 int baseline_ptr = 0;
laserdad 10:7fbf298ee05f 196 uint32_t running_baseline = 240;
laserdad 3:d3a1fc19bee6 197 int first = 1;
laserdad 3:d3a1fc19bee6 198 uint32_t IRavg = 0;
laserdad 3:d3a1fc19bee6 199 uint32_t Ravg = 0;
laserdad 3:d3a1fc19bee6 200 uint32_t IRprev = 0;
laserdad 3:d3a1fc19bee6 201 uint32_t Rprev = 0;
laserdad 3:d3a1fc19bee6 202 uint32_t prevAvg = 0;
laserdad 3:d3a1fc19bee6 203 uint32_t IR_avg_buffer[running_avg];
laserdad 3:d3a1fc19bee6 204 uint32_t R_avg_buffer[running_avg];
laserdad 4:3aee2ca931b8 205 uint32_t IR_baseline_buffer[running_baseline];
laserdad 4:3aee2ca931b8 206 uint32_t R_baseline_buffer[running_baseline];
laserdad 4:3aee2ca931b8 207 uint32_t IRbaseline_prev=0;;
laserdad 4:3aee2ca931b8 208 uint32_t Rbaseline_prev=0;;
laserdad 4:3aee2ca931b8 209 uint32_t IRbaseline=0;
laserdad 4:3aee2ca931b8 210 uint32_t Rbaseline=0;
laserdad 4:3aee2ca931b8 211 uint32_t prevBaseline=0;
laserdad 7:3ed0f0522b43 212 uint32_t PSavg = 0;
laserdad 7:3ed0f0522b43 213 uint32_t PSprev = 0;
laserdad 7:3ed0f0522b43 214 uint32_t PS_avg_buffer[ps_running_avg];
laserdad 7:3ed0f0522b43 215
laserdad 13:5ce84c68066e 216 uint32_t targetIRcounts = 196608; //0.75 of full scale
laserdad 13:5ce84c68066e 217 uint32_t targetRcounts = 196608; //0.75 of full scale
laserdad 13:5ce84c68066e 218 // uint32_t tol1 = 8192; //1 5 bit increment
laserdad 13:5ce84c68066e 219 uint32_t tol1 = 4096; //1 5 bit increment
laserdad 13:5ce84c68066e 220 uint32_t tol2 = 39321; //for 90% and 60% large limits
laserdad 13:5ce84c68066e 221 uint32_t step = 8;
laserdad 13:5ce84c68066e 222 uint32_t IR_in_range = 0;
laserdad 13:5ce84c68066e 223 uint32_t R_in_range = 0;
laserdad 13:5ce84c68066e 224 bool update = 0;
laserdad 13:5ce84c68066e 225 uint32_t in_range_persist = 2;
laserdad 13:5ce84c68066e 226
laserdad 7:3ed0f0522b43 227 for (int n=0;n<ps_running_avg;n++)
laserdad 7:3ed0f0522b43 228 {
laserdad 7:3ed0f0522b43 229 PS_avg_buffer[n] =0;
laserdad 7:3ed0f0522b43 230 }
laserdad 7:3ed0f0522b43 231
laserdad 2:ee175f471ecb 232 i2c.frequency( 400000 );
laserdad 0:e9ae48b7f6f6 233 char valid;
laserdad 4:3aee2ca931b8 234 uint32_t ps_ls_data[7];
laserdad 10:7fbf298ee05f 235 char samples2Read = 6; //samples, e.g. 4 samples * 3 bytes = 12 bytes (or 2 SpO2 samples)
laserdad 2:ee175f471ecb 236 char fifoBuffer[samples2Read*3];
laserdad 0:e9ae48b7f6f6 237 uint32_t ppgData[samples2Read];
laserdad 0:e9ae48b7f6f6 238
laserdad 1:fb6b2b4d5d8a 239
laserdad 1:fb6b2b4d5d8a 240 pc.printf("register settings\r\n");
laserdad 1:fb6b2b4d5d8a 241 regDump(OB1203_ADDR,0,19);
laserdad 1:fb6b2b4d5d8a 242 regDump(OB1203_ADDR,20,39);
laserdad 1:fb6b2b4d5d8a 243 regDump(OB1203_ADDR,40,59);
laserdad 1:fb6b2b4d5d8a 244 regDump(OB1203_ADDR,60,77);
laserdad 1:fb6b2b4d5d8a 245
laserdad 1:fb6b2b4d5d8a 246 pc.printf("do initial config\r\n");
laserdad 0:e9ae48b7f6f6 247 defaultConfig(); //rgb ps
laserdad 1:fb6b2b4d5d8a 248
laserdad 1:fb6b2b4d5d8a 249 pc.printf("print new register config\r\n");
laserdad 1:fb6b2b4d5d8a 250 regDump(OB1203_ADDR,0,19);
laserdad 1:fb6b2b4d5d8a 251 regDump(OB1203_ADDR,20,39);
laserdad 1:fb6b2b4d5d8a 252 regDump(OB1203_ADDR,40,59);
laserdad 1:fb6b2b4d5d8a 253 regDump(OB1203_ADDR,60,77);
laserdad 1:fb6b2b4d5d8a 254
laserdad 0:e9ae48b7f6f6 255
laserdad 0:e9ae48b7f6f6 256 intb.fall(&intEvent);
laserdad 3:d3a1fc19bee6 257 t.start();
laserdad 5:ebe305e08430 258
laserdad 0:e9ae48b7f6f6 259 while(1)
laserdad 0:e9ae48b7f6f6 260 {
laserdad 1:fb6b2b4d5d8a 261 if(mode)
laserdad 0:e9ae48b7f6f6 262 {
laserdad 2:ee175f471ecb 263 if(!intb.read())
laserdad 2:ee175f471ecb 264 {
laserdad 4:3aee2ca931b8 265 if(!afull)
laserdad 4:3aee2ca931b8 266 {
laserdad 4:3aee2ca931b8 267 numInts++; //get data every other interrupt if ppg new data interrupt mode
laserdad 4:3aee2ca931b8 268 }
laserdad 4:3aee2ca931b8 269 else
laserdad 4:3aee2ca931b8 270 {
laserdad 4:3aee2ca931b8 271 numInts = samples2Read;
laserdad 4:3aee2ca931b8 272 }
laserdad 2:ee175f471ecb 273 intFlagged = 1;
laserdad 4:3aee2ca931b8 274 if( (numInts < samples2Read) && !afull)
laserdad 4:3aee2ca931b8 275 {
laserdad 4:3aee2ca931b8 276 ob1203.get_status();
laserdad 4:3aee2ca931b8 277 }
laserdad 4:3aee2ca931b8 278 else if(intFlagged && (numInts==samples2Read) )
laserdad 3:d3a1fc19bee6 279 {
laserdad 4:3aee2ca931b8 280 numInts = 0;
laserdad 4:3aee2ca931b8 281 ob1203.getFifoSamples(samples2Read,fifoBuffer);
laserdad 4:3aee2ca931b8 282 // for (int n=0;n<samples2Read*3;n++)
laserdad 4:3aee2ca931b8 283 // {
laserdad 4:3aee2ca931b8 284 // pc.printf("%02X ",fifoBuffer[n]);
laserdad 4:3aee2ca931b8 285 // }
laserdad 4:3aee2ca931b8 286 // pc.printf("\r\n");
laserdad 4:3aee2ca931b8 287 ob1203.parseFifoSamples(samples2Read,fifoBuffer,ppgData);
laserdad 4:3aee2ca931b8 288 // for (int n=0;n<samples2Read;n++)
laserdad 4:3aee2ca931b8 289 // {
laserdad 4:3aee2ca931b8 290 // pc.printf("%d ",ppgData[n]);
laserdad 4:3aee2ca931b8 291 // }
laserdad 4:3aee2ca931b8 292 // pc.printf("\r\n");
laserdad 4:3aee2ca931b8 293 if(first) //populate average and baseline buffers the first time we run
laserdad 3:d3a1fc19bee6 294 {
laserdad 4:3aee2ca931b8 295 for(int n=0;n<running_avg;n++)
laserdad 4:3aee2ca931b8 296 {
laserdad 4:3aee2ca931b8 297 IR_avg_buffer[n] = ppgData[0];
laserdad 4:3aee2ca931b8 298 IRavg += IR_avg_buffer[n];
laserdad 4:3aee2ca931b8 299 if(spo2)
laserdad 4:3aee2ca931b8 300 {
laserdad 4:3aee2ca931b8 301 R_avg_buffer[n] = ppgData[1];
laserdad 4:3aee2ca931b8 302 Ravg += R_avg_buffer[n];
laserdad 4:3aee2ca931b8 303 }
laserdad 4:3aee2ca931b8 304
laserdad 4:3aee2ca931b8 305 }
laserdad 4:3aee2ca931b8 306 for( int n=0;n<running_baseline;n++)
laserdad 4:3aee2ca931b8 307 {
laserdad 4:3aee2ca931b8 308 // IR_baseline_buffer[n] = ppgData[0];
laserdad 4:3aee2ca931b8 309 IR_baseline_buffer[n] = 0;
laserdad 4:3aee2ca931b8 310 if(spo2)
laserdad 4:3aee2ca931b8 311 {
laserdad 4:3aee2ca931b8 312 // R_baseline_buffer[n] = ppgData[1];
laserdad 4:3aee2ca931b8 313 R_baseline_buffer[n] = 0;
laserdad 4:3aee2ca931b8 314 }
laserdad 4:3aee2ca931b8 315 }
laserdad 4:3aee2ca931b8 316 first = 0;
laserdad 4:3aee2ca931b8 317 // IRbaseline = running_baseline*ppgData[0];
laserdad 4:3aee2ca931b8 318 // Rbaseline = running_baseline*ppgData[1];
laserdad 13:5ce84c68066e 319 }//end if first
laserdad 13:5ce84c68066e 320
laserdad 4:3aee2ca931b8 321 for (int n=0;n<samples2Read/2;n++)
laserdad 4:3aee2ca931b8 322 {
laserdad 4:3aee2ca931b8 323 ( avg_ptr+1 == running_avg ) ? avg_ptr = 0 : avg_ptr++;
laserdad 4:3aee2ca931b8 324 ( baseline_ptr+1 == running_baseline) ? baseline_ptr = 0 : baseline_ptr++;
laserdad 4:3aee2ca931b8 325 IRprev = IR_avg_buffer[avg_ptr]; //load the sample you are about to write over
laserdad 4:3aee2ca931b8 326 IR_avg_buffer[avg_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 4:3aee2ca931b8 327 IRavg += (IR_avg_buffer[avg_ptr] - IRprev); //update the average by removing the old sample and adding the new
laserdad 4:3aee2ca931b8 328
laserdad 4:3aee2ca931b8 329 IRbaseline_prev = IR_baseline_buffer[baseline_ptr]; //load the sample you are about to write over
laserdad 4:3aee2ca931b8 330 IR_baseline_buffer[baseline_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 4:3aee2ca931b8 331 IRbaseline += (IR_baseline_buffer[baseline_ptr] - IRbaseline_prev); //update the average by removing the old sample and adding the new
laserdad 4:3aee2ca931b8 332
laserdad 3:d3a1fc19bee6 333 if(spo2)
laserdad 3:d3a1fc19bee6 334 {
laserdad 4:3aee2ca931b8 335 Rprev = R_avg_buffer[avg_ptr];
laserdad 4:3aee2ca931b8 336 R_avg_buffer[avg_ptr] = ppgData[2*n+1];
laserdad 4:3aee2ca931b8 337 Ravg += (R_avg_buffer[avg_ptr] - Rprev);
IDTsanjoseuser 8:21738f9c5835 338
laserdad 4:3aee2ca931b8 339 // pc.printf("%d, %d, %d, %d\r\n",IRavg/running_avg,Ravg/running_avg, IR_avg_buffer[avg_ptr],R_avg_buffer[avg_ptr]);
laserdad 4:3aee2ca931b8 340
laserdad 4:3aee2ca931b8 341 Rbaseline_prev = R_baseline_buffer[baseline_ptr];
laserdad 4:3aee2ca931b8 342 R_baseline_buffer[baseline_ptr] = ppgData[2*n+1];
laserdad 4:3aee2ca931b8 343 Rbaseline += (R_baseline_buffer[baseline_ptr] - Rbaseline_prev);
laserdad 4:3aee2ca931b8 344
laserdad 13:5ce84c68066e 345 if(printAvg)
laserdad 13:5ce84c68066e 346 {
IDTsanjoseuser 8:21738f9c5835 347 //PRINT AVG DATA
laserdad 13:5ce84c68066e 348 pc.printf("%d,%d,%d\r\n",t.read_us(),IRavg/running_avg,Ravg/running_avg);
laserdad 4:3aee2ca931b8 349 // pc.printf("%d,%d\r\n",IRavg/running_avg-IRbaseline/running_baseline, Ravg/running_avg-Rbaseline/running_baseline);
laserdad 4:3aee2ca931b8 350 // pc.printf("%d,%d,%d,%d\r\n",Ravg/running_avg,Rbaseline/running_baseline,Rbaseline_prev,Ravg/running_avg-Rbaseline/running_baseline);
laserdad 13:5ce84c68066e 351 }
laserdad 13:5ce84c68066e 352 else
laserdad 13:5ce84c68066e 353 {
laserdad 13:5ce84c68066e 354 //PRINT RAW DATA
laserdad 13:5ce84c68066e 355 pc.printf("%d, %d, %d\r\n",t.read_us(),ppgData[2*n],ppgData[2*n+1]); //print with us counter time stamp (use only with slower data rates or averaging as this slows down the data printing);
laserdad 13:5ce84c68066e 356 // pc.printf("%d, %d\r\n",ppgData[2*n],ppgData[2*n+1]); //print without us timer (faster)
laserdad 13:5ce84c68066e 357 }
laserdad 13:5ce84c68066e 358 }//end SpO2 case
laserdad 4:3aee2ca931b8 359 else
laserdad 4:3aee2ca931b8 360 {
laserdad 4:3aee2ca931b8 361 ( avg_ptr+1 == running_avg ) ? avg_ptr = 0 : avg_ptr++;
laserdad 4:3aee2ca931b8 362 ( baseline_ptr+1 == running_baseline) ? baseline_ptr = 0 : baseline_ptr++;
laserdad 4:3aee2ca931b8 363 IRprev = IR_avg_buffer[avg_ptr];
laserdad 4:3aee2ca931b8 364 IR_avg_buffer[avg_ptr] = ppgData[2*n+1];
laserdad 4:3aee2ca931b8 365 prevAvg = IRavg;
laserdad 4:3aee2ca931b8 366 IRavg += (IR_avg_buffer[avg_ptr] - IRprev);
laserdad 4:3aee2ca931b8 367
laserdad 4:3aee2ca931b8 368 IRbaseline_prev = IR_baseline_buffer[baseline_ptr]; //load the sample you are about to write over
laserdad 4:3aee2ca931b8 369 IR_baseline_buffer[baseline_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 4:3aee2ca931b8 370 prevBaseline = IRbaseline;
laserdad 4:3aee2ca931b8 371 IRbaseline += (IR_baseline_buffer[baseline_ptr] - IRbaseline_prev); //update the average by removing the old sample and adding the new
IDTsanjoseuser 8:21738f9c5835 372
laserdad 4:3aee2ca931b8 373
laserdad 13:5ce84c68066e 374 if(printAvg)
laserdad 13:5ce84c68066e 375 {
IDTsanjoseuser 8:21738f9c5835 376 //PRINT AVG DATA
laserdad 13:5ce84c68066e 377 pc.printf("%d\r\n%d\r\n",prevAvg/running_avg-prevBaseline/running_baseline,IRavg/running_avg-IRbaseline/running_baseline);
laserdad 13:5ce84c68066e 378 }
laserdad 13:5ce84c68066e 379 else
laserdad 13:5ce84c68066e 380 {
laserdad 13:5ce84c68066e 381 //PRINT RAW DATA
laserdad 13:5ce84c68066e 382 pc.printf("%d\r\n%d\r\n",ppgData[2*n],ppgData[2*n+1]);
laserdad 13:5ce84c68066e 383 // pc.printf("%d, %d, %d\r\n",t.read_us(),ppgData[2*n],ppgData[2*n+1]); //print with us counter time stamp (use only with slower data rates or averaging as this slows down the data printing);
laserdad 13:5ce84c68066e 384
laserdad 13:5ce84c68066e 385 }
laserdad 13:5ce84c68066e 386 }//HR case
laserdad 13:5ce84c68066e 387 if(n+1==samples2Read/2)
laserdad 13:5ce84c68066e 388 {
laserdad 13:5ce84c68066e 389 if(IRAGC)
laserdad 13:5ce84c68066e 390 {
laserdad 13:5ce84c68066e 391 if( ppgData[2*n] > targetIRcounts + (IR_in_range>in_range_persist ? tol2: tol1) )
laserdad 13:5ce84c68066e 392 {
laserdad 13:5ce84c68066e 393 if(ppgData[2*n]>targetIRcounts + tol2)
laserdad 13:5ce84c68066e 394 IR_in_range=0;
laserdad 13:5ce84c68066e 395 if(ob1203.ir_current>step)
laserdad 13:5ce84c68066e 396 {
laserdad 13:5ce84c68066e 397 // pc.printf("IR %d, IRc %d--",ppgData[2*n],ob1203.ir_current);
laserdad 13:5ce84c68066e 398 ob1203.ir_current -= step;
laserdad 13:5ce84c68066e 399 update = 1;
laserdad 13:5ce84c68066e 400
laserdad 13:5ce84c68066e 401 }
laserdad 13:5ce84c68066e 402 }
laserdad 13:5ce84c68066e 403 else if( ppgData[2*n] < targetIRcounts - (IR_in_range>in_range_persist ? tol2 : tol1) )
laserdad 13:5ce84c68066e 404 {
laserdad 13:5ce84c68066e 405 if(ppgData[2*n]<targetIRcounts - tol2)
laserdad 13:5ce84c68066e 406 IR_in_range=0;
laserdad 13:5ce84c68066e 407 if(ob1203.ir_current+step<0x2AF) //no need to go to full current
laserdad 13:5ce84c68066e 408 {
laserdad 13:5ce84c68066e 409 ob1203.ir_current += step;
laserdad 13:5ce84c68066e 410 update = 1;
laserdad 13:5ce84c68066e 411 // pc.printf("IR %d, IRc %d++", ppgData[2*n],ob1203.ir_current);
laserdad 13:5ce84c68066e 412 }
laserdad 13:5ce84c68066e 413 }
laserdad 13:5ce84c68066e 414 else
laserdad 13:5ce84c68066e 415 {
laserdad 13:5ce84c68066e 416 IR_in_range++;
laserdad 13:5ce84c68066e 417 }
laserdad 13:5ce84c68066e 418 }//end IR AGC case
laserdad 13:5ce84c68066e 419
laserdad 13:5ce84c68066e 420 if(spo2 && redAGC)
laserdad 13:5ce84c68066e 421 {
laserdad 13:5ce84c68066e 422 if( ppgData[2*n+1] > targetRcounts + (R_in_range>in_range_persist ? tol2 : tol1) )
laserdad 13:5ce84c68066e 423 {
laserdad 13:5ce84c68066e 424 if(ppgData[2*n+1]>targetRcounts + tol2)
laserdad 13:5ce84c68066e 425 R_in_range=0;
laserdad 13:5ce84c68066e 426 if(ob1203.r_current>step)
laserdad 13:5ce84c68066e 427 {
laserdad 13:5ce84c68066e 428 // pc.printf(", R %d, Rc %d--\r\n", ppgData[2*n+1],ob1203.r_current);
laserdad 13:5ce84c68066e 429 ob1203.r_current -= step;
laserdad 13:5ce84c68066e 430 update = 1;
laserdad 13:5ce84c68066e 431 }
laserdad 13:5ce84c68066e 432 }
laserdad 13:5ce84c68066e 433 else if( ppgData[2*n+1] < targetRcounts - (R_in_range>in_range_persist ? tol2 : tol1) )
laserdad 13:5ce84c68066e 434 {
laserdad 13:5ce84c68066e 435 if(ppgData[2*n+1]<targetRcounts - tol2)
laserdad 13:5ce84c68066e 436 R_in_range=0;
laserdad 13:5ce84c68066e 437 if(ob1203.r_current+step<0x1FF)
laserdad 13:5ce84c68066e 438 {
laserdad 13:5ce84c68066e 439
laserdad 13:5ce84c68066e 440 // pc.printf(", R %d, Rc %d++\r\n", ppgData[2*n+1],ob1203.r_current);
laserdad 13:5ce84c68066e 441 ob1203.r_current += step;
laserdad 13:5ce84c68066e 442 update = 1;
laserdad 13:5ce84c68066e 443 }
laserdad 13:5ce84c68066e 444 }
laserdad 13:5ce84c68066e 445 else
laserdad 13:5ce84c68066e 446 {
laserdad 13:5ce84c68066e 447 R_in_range++;
laserdad 13:5ce84c68066e 448 }
laserdad 13:5ce84c68066e 449 if(update)
laserdad 13:5ce84c68066e 450 {
laserdad 13:5ce84c68066e 451 ob1203.setPPGcurrent();
laserdad 13:5ce84c68066e 452 ob1203.resetFIFO();
laserdad 13:5ce84c68066e 453 update=0;
laserdad 13:5ce84c68066e 454 }
laserdad 13:5ce84c68066e 455 }//end R AGC case
laserdad 4:3aee2ca931b8 456 }
laserdad 13:5ce84c68066e 457 }//end sample loop
laserdad 13:5ce84c68066e 458
laserdad 13:5ce84c68066e 459
laserdad 13:5ce84c68066e 460
laserdad 13:5ce84c68066e 461 intFlagged = 0;
laserdad 13:5ce84c68066e 462
laserdad 13:5ce84c68066e 463 }//end if time to read samples
laserdad 4:3aee2ca931b8 464 } //end if !intb
laserdad 4:3aee2ca931b8 465 }// end mode
laserdad 0:e9ae48b7f6f6 466 else
laserdad 0:e9ae48b7f6f6 467 {
laserdad 1:fb6b2b4d5d8a 468 wait_ms(sample_delay);
laserdad 5:ebe305e08430 469 if( meas_ps ? ob1203.psIsNew() : ob1203.lsIsNew() )
laserdad 1:fb6b2b4d5d8a 470 {
laserdad 5:ebe305e08430 471 meas_ps ? valid = ob1203.get_ps_ls_data(ps_ls_data) : valid = ob1203.get_ls_data(ps_ls_data);
laserdad 7:3ed0f0522b43 472 if(meas_ps)
laserdad 7:3ed0f0522b43 473 {
laserdad 7:3ed0f0522b43 474 ( ps_avg_ptr+1 == ps_running_avg ) ? ps_avg_ptr = 0 : ps_avg_ptr++;
laserdad 7:3ed0f0522b43 475 PSprev = PS_avg_buffer[ps_avg_ptr]; //load the sample you are about to write over
laserdad 7:3ed0f0522b43 476 PS_avg_buffer[ps_avg_ptr] = ps_ls_data[0]; //load the new sample in the buffer
laserdad 7:3ed0f0522b43 477 PSavg += (PS_avg_buffer[ps_avg_ptr] - PSprev); //update the average by removing the old sample and adding the new
laserdad 7:3ed0f0522b43 478 // pc.printf("%d %d %d %d %d ",ps_avg_ptr, PSprev, PS_avg_buffer[ps_avg_ptr],ps_ls_data[0],PSavg);
laserdad 7:3ed0f0522b43 479 }
laserdad 5:ebe305e08430 480 if (meas_temp)
laserdad 5:ebe305e08430 481 {
laserdad 5:ebe305e08430 482 ob1203.setMainConfig();
laserdad 5:ebe305e08430 483 }
laserdad 12:5de5f550e765 484 pc.printf("%d, %d %d %d %d %d\r\n",ps_ls_data[0],ps_ls_data[1],ps_ls_data[2],ps_ls_data[3],ps_ls_data[4],ps_ls_data[5]);
laserdad 12:5de5f550e765 485 // pc.printf("%d, %d %d %d %d %d %d %d\r\n",(PSavg/ps_running_avg),ps_ls_data[0],ps_ls_data[1],ps_ls_data[2],ps_ls_data[3],ps_ls_data[4],ps_ls_data[5],ps_ls_data[6]);
laserdad 4:3aee2ca931b8 486
laserdad 1:fb6b2b4d5d8a 487 }
laserdad 2:ee175f471ecb 488 // else
laserdad 2:ee175f471ecb 489 // {
laserdad 2:ee175f471ecb 490 // pc.printf("status = %04X\r\n",ob1203.get_status() );
laserdad 2:ee175f471ecb 491 // }
laserdad 0:e9ae48b7f6f6 492 }
laserdad 1:fb6b2b4d5d8a 493 }//end while
laserdad 1:fb6b2b4d5d8a 494 }//end main