IDT Optical Sensors / Mbed 2 deprecated OB1203_IDT

Dependencies:   mbed OB1203_example_driver

Committer:
laserdad
Date:
Mon May 14 19:31:50 2018 +0000
Revision:
6:aaa2f8fb5123
Parent:
5:ebe305e08430
Child:
7:3ed0f0522b43
fixed temp readout (byte swap)

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 1:fb6b2b4d5d8a 8
laserdad 0:e9ae48b7f6f6 9 I2C i2c(I2C_SDA,I2C_SCL);
laserdad 4:3aee2ca931b8 10 //SoftI2C i2c(I2C_SDA,I2C_SCL);
laserdad 0:e9ae48b7f6f6 11 InterruptIn intb(intb_pin);
laserdad 0:e9ae48b7f6f6 12 DigitalOut sda_pullup(D11,1);
laserdad 0:e9ae48b7f6f6 13 DigitalOut scl_pullup(D12,1);
laserdad 0:e9ae48b7f6f6 14 DigitalOut intb_pullup(D13,1);
laserdad 0:e9ae48b7f6f6 15
laserdad 0:e9ae48b7f6f6 16 OB1203 ob1203(&i2c);
laserdad 2:ee175f471ecb 17 Serial pc(USBTX, USBRX,256000);
laserdad 0:e9ae48b7f6f6 18 Timer t;
laserdad 0:e9ae48b7f6f6 19
laserdad 1:fb6b2b4d5d8a 20
laserdad 6:aaa2f8fb5123 21 //USER CONFIGURABLE*********
laserdad 5:ebe305e08430 22 bool mode = 0; //0 for PS_LS, 1 for PPG
laserdad 6:aaa2f8fb5123 23 bool meas_ps = 0;
laserdad 3:d3a1fc19bee6 24 bool spo2 = 1; //0 for HR, 1 for SpO2
laserdad 4:3aee2ca931b8 25 bool afull = 1; //use Afull interrupt--otherwise PPG new data interrupt
laserdad 5:ebe305e08430 26 bool meas_temp = 1;
laserdad 6:aaa2f8fb5123 27 //****************************
laserdad 6:aaa2f8fb5123 28
laserdad 6:aaa2f8fb5123 29 //internal settings
laserdad 6:aaa2f8fb5123 30 bool intFlagged =0;
laserdad 6:aaa2f8fb5123 31 int sample_delay = 25; //ms
laserdad 1:fb6b2b4d5d8a 32
laserdad 0:e9ae48b7f6f6 33 void defaultConfig()
laserdad 0:e9ae48b7f6f6 34 {
laserdad 4:3aee2ca931b8 35 meas_temp ? ob1203.temp_en = TEMP_ON : ob1203.temp_en = TEMP_OFF;
laserdad 4:3aee2ca931b8 36
laserdad 4:3aee2ca931b8 37 ob1203.ls_res = LS_RES(0); //2= 18bit 100ms, 0= max res
laserdad 4:3aee2ca931b8 38 ob1203.ls_rate = LS_RATE(4); //2 =100ms, 4 = 500ms
laserdad 4:3aee2ca931b8 39 ob1203.ls_gain = LS_GAIN(3); //gain 3 default (range)
laserdad 1:fb6b2b4d5d8a 40 ob1203.ls_thres_hi = 0x000FFFFF;
laserdad 0:e9ae48b7f6f6 41 ob1203.ls_thres_lo = 0;
laserdad 0:e9ae48b7f6f6 42 ob1203.ls_sai = LS_SAI_OFF;
laserdad 0:e9ae48b7f6f6 43 ob1203.ls_mode = RGB_MODE;
laserdad 0:e9ae48b7f6f6 44 ob1203.ls_en = LS_ON;
laserdad 4:3aee2ca931b8 45
laserdad 0:e9ae48b7f6f6 46 ob1203.ps_sai_en = PS_SAI_OFF;
laserdad 5:ebe305e08430 47 // ob1203.ps_sai_en = PS_SAI_ON;
laserdad 1:fb6b2b4d5d8a 48 if(mode)
laserdad 1:fb6b2b4d5d8a 49 {
laserdad 3:d3a1fc19bee6 50 if (spo2)
laserdad 3:d3a1fc19bee6 51 {
laserdad 3:d3a1fc19bee6 52 ob1203.ppg_ps_mode = SPO2_MODE;
laserdad 3:d3a1fc19bee6 53 }
laserdad 3:d3a1fc19bee6 54 else
laserdad 3:d3a1fc19bee6 55 {
laserdad 3:d3a1fc19bee6 56 ob1203.ppg_ps_mode = HR_MODE;
laserdad 3:d3a1fc19bee6 57 }
laserdad 3:d3a1fc19bee6 58
laserdad 1:fb6b2b4d5d8a 59 }
laserdad 1:fb6b2b4d5d8a 60 else
laserdad 1:fb6b2b4d5d8a 61 {
laserdad 1:fb6b2b4d5d8a 62 ob1203.ppg_ps_mode = PS_MODE;
laserdad 1:fb6b2b4d5d8a 63 }
laserdad 1:fb6b2b4d5d8a 64 ob1203.ps_pulses = PS_PULSES(2);
laserdad 1:fb6b2b4d5d8a 65 // pc.printf("ps_pulses = %02X\r\n",ob1203.ps_pulses);
laserdad 3:d3a1fc19bee6 66 ob1203.ps_pwidth = PS_PWIDTH(4);
laserdad 3:d3a1fc19bee6 67 ob1203.ps_rate = PS_RATE(3);
laserdad 1:fb6b2b4d5d8a 68 // pc.printf("ps_rate = %02X\r\n",ob1203.ps_rate);
laserdad 0:e9ae48b7f6f6 69 ob1203.ps_avg_en = PS_AVG_OFF;
laserdad 0:e9ae48b7f6f6 70 ob1203.ps_can_ana = PS_CAN_ANA_0;
laserdad 0:e9ae48b7f6f6 71 ob1203.ps_digital_can = 0;
laserdad 0:e9ae48b7f6f6 72 ob1203.ps_hys_level = 0;
laserdad 4:3aee2ca931b8 73 meas_ps ? ob1203.ps_current = 0x3FF : ob1203.ps_current = 0x000;
laserdad 4:3aee2ca931b8 74 // ob1203.ps_current = 0;
laserdad 0:e9ae48b7f6f6 75 ob1203.ps_thres_hi = 0xFF;
laserdad 0:e9ae48b7f6f6 76 ob1203.ps_thres_lo = 0x00;
laserdad 0:e9ae48b7f6f6 77
laserdad 0:e9ae48b7f6f6 78 //interrupts
laserdad 0:e9ae48b7f6f6 79 ob1203.ls_int_sel = LS_INT_SEL_W;
laserdad 0:e9ae48b7f6f6 80 ob1203.ls_var_mode = LS_THRES_INT_MODE;
laserdad 0:e9ae48b7f6f6 81 ob1203.ls_int_en = LS_INT_ON;
laserdad 0:e9ae48b7f6f6 82 ob1203.ppg_ps_en = PPG_PS_ON;
laserdad 4:3aee2ca931b8 83
laserdad 0:e9ae48b7f6f6 84 ob1203.ps_logic_mode = PS_INT_READ_CLEARS;
laserdad 0:e9ae48b7f6f6 85 ob1203.ps_int_en = PS_INT_ON;
laserdad 0:e9ae48b7f6f6 86 ob1203.ls_persist = LS_PERSIST(2);
laserdad 0:e9ae48b7f6f6 87 ob1203.ps_persist = PS_PERSIST(2);
laserdad 4:3aee2ca931b8 88 //int
laserdad 4:3aee2ca931b8 89 if(afull)
laserdad 4:3aee2ca931b8 90 {
laserdad 4:3aee2ca931b8 91 ob1203.afull_int_en = AFULL_INT_ON;
laserdad 4:3aee2ca931b8 92 ob1203.ppg_int_en = PPG_INT_OFF;
laserdad 4:3aee2ca931b8 93 }
laserdad 4:3aee2ca931b8 94 else
laserdad 4:3aee2ca931b8 95 {
laserdad 4:3aee2ca931b8 96 ob1203.afull_int_en = AFULL_INT_OFF;
laserdad 4:3aee2ca931b8 97 ob1203.ppg_int_en = PPG_INT_ON;
laserdad 4:3aee2ca931b8 98 }
laserdad 0:e9ae48b7f6f6 99 //PPG
laserdad 6:aaa2f8fb5123 100 ob1203.ir_current = 511; //max 1023. 3FF
laserdad 3:d3a1fc19bee6 101 if (spo2)
laserdad 3:d3a1fc19bee6 102 {
laserdad 4:3aee2ca931b8 103 // ob1203.r_current = 0x0FF;
laserdad 6:aaa2f8fb5123 104 ob1203.r_current = 511; //max 511. 1FF
laserdad 3:d3a1fc19bee6 105 }
laserdad 3:d3a1fc19bee6 106 else
laserdad 3:d3a1fc19bee6 107 {
laserdad 3:d3a1fc19bee6 108 ob1203.r_current = 0;
laserdad 3:d3a1fc19bee6 109 }
laserdad 6:aaa2f8fb5123 110 ob1203.ppg_ps_gain = PPG_PS_GAIN_2;
laserdad 0:e9ae48b7f6f6 111 ob1203.ppg_pow_save = PPG_POW_SAVE_OFF;
laserdad 0:e9ae48b7f6f6 112 ob1203.led_flip = LED_FLIP_OFF;
laserdad 0:e9ae48b7f6f6 113 ob1203.ch1_can_ana = PPG_CH1_CAN(0);
laserdad 0:e9ae48b7f6f6 114 ob1203.ch2_can_ana = PPG_CH2_CAN(0);
laserdad 4:3aee2ca931b8 115 ob1203.ppg_avg = PPG_AVG(2); //2^n
laserdad 3:d3a1fc19bee6 116 ob1203.ppg_rate = PPG_RATE(1);
laserdad 3:d3a1fc19bee6 117 ob1203.ppg_pwidth = PPG_PWIDTH(3);
laserdad 0:e9ae48b7f6f6 118 ob1203.ppg_freq = PPG_FREQ_60HZ;
laserdad 2:ee175f471ecb 119 // ob1203.ppg_freq = PPG_FREQ_50HZ;
laserdad 3:d3a1fc19bee6 120
laserdad 0:e9ae48b7f6f6 121 ob1203.fifo_rollover_en = FIFO_ROLL_ON;
laserdad 0:e9ae48b7f6f6 122 ob1203.fifo_afull_samples_left = AFULL_SAMPLES_LEFT(8);
laserdad 0:e9ae48b7f6f6 123
laserdad 0:e9ae48b7f6f6 124 if(mode)
laserdad 0:e9ae48b7f6f6 125 {
laserdad 3:d3a1fc19bee6 126 if(spo2)
laserdad 3:d3a1fc19bee6 127 {
laserdad 3:d3a1fc19bee6 128 ob1203.init_spo2();
laserdad 3:d3a1fc19bee6 129 }
laserdad 3:d3a1fc19bee6 130 else
laserdad 3:d3a1fc19bee6 131 {
laserdad 3:d3a1fc19bee6 132 ob1203.init_hr();
laserdad 3:d3a1fc19bee6 133 }
laserdad 0:e9ae48b7f6f6 134 }
laserdad 0:e9ae48b7f6f6 135 else
laserdad 0:e9ae48b7f6f6 136 {
laserdad 5:ebe305e08430 137 meas_ps ? ob1203.init_ps_rgb() : ob1203.init_rgb();
laserdad 0:e9ae48b7f6f6 138 }
laserdad 0:e9ae48b7f6f6 139 }
laserdad 0:e9ae48b7f6f6 140
laserdad 1:fb6b2b4d5d8a 141 void regDump(uint8_t Addr, uint8_t startByte, uint8_t endByte)
laserdad 1:fb6b2b4d5d8a 142 {
laserdad 1:fb6b2b4d5d8a 143 /*print the values of up to 20 registers--buffer limit, e.g.*/
laserdad 1:fb6b2b4d5d8a 144 char regData[20];
laserdad 1:fb6b2b4d5d8a 145 int numBytes;
laserdad 1:fb6b2b4d5d8a 146 if (endByte>=startByte) {
laserdad 1:fb6b2b4d5d8a 147 numBytes = (endByte-startByte+1) < 20 ? (endByte-startByte+1) : 20;
laserdad 1:fb6b2b4d5d8a 148 } else {
laserdad 1:fb6b2b4d5d8a 149 numBytes=1;
laserdad 1:fb6b2b4d5d8a 150 }
laserdad 1:fb6b2b4d5d8a 151
laserdad 1:fb6b2b4d5d8a 152 regData[0] = startByte;
laserdad 1:fb6b2b4d5d8a 153 i2c.write(Addr,regData,1,true);
laserdad 1:fb6b2b4d5d8a 154 i2c.read(Addr, regData, numBytes);
laserdad 1:fb6b2b4d5d8a 155 for(int n=0; n<numBytes; n++) {
laserdad 1:fb6b2b4d5d8a 156 pc.printf("%02X, %02X \r\n", startByte+n, regData[n]);
laserdad 1:fb6b2b4d5d8a 157 }
laserdad 1:fb6b2b4d5d8a 158 }
laserdad 1:fb6b2b4d5d8a 159
laserdad 0:e9ae48b7f6f6 160
laserdad 0:e9ae48b7f6f6 161 void intEvent(void)
laserdad 0:e9ae48b7f6f6 162 {
laserdad 0:e9ae48b7f6f6 163 intFlagged = 1;
laserdad 0:e9ae48b7f6f6 164 }
laserdad 0:e9ae48b7f6f6 165
laserdad 0:e9ae48b7f6f6 166 int main()
laserdad 0:e9ae48b7f6f6 167 {
laserdad 4:3aee2ca931b8 168 int numInts = 0;
laserdad 4:3aee2ca931b8 169 uint32_t running_avg = 65;
laserdad 3:d3a1fc19bee6 170 char avg_ptr = 0;
laserdad 4:3aee2ca931b8 171 int baseline_ptr = 0;
laserdad 4:3aee2ca931b8 172 uint32_t running_baseline = 850;
laserdad 3:d3a1fc19bee6 173 int first = 1;
laserdad 3:d3a1fc19bee6 174 uint32_t IRavg = 0;
laserdad 3:d3a1fc19bee6 175 uint32_t Ravg = 0;
laserdad 3:d3a1fc19bee6 176 uint32_t IRprev = 0;
laserdad 3:d3a1fc19bee6 177 uint32_t Rprev = 0;
laserdad 3:d3a1fc19bee6 178 uint32_t prevAvg = 0;
laserdad 3:d3a1fc19bee6 179 uint32_t IR_avg_buffer[running_avg];
laserdad 3:d3a1fc19bee6 180 uint32_t R_avg_buffer[running_avg];
laserdad 4:3aee2ca931b8 181 uint32_t IR_baseline_buffer[running_baseline];
laserdad 4:3aee2ca931b8 182 uint32_t R_baseline_buffer[running_baseline];
laserdad 4:3aee2ca931b8 183 uint32_t IRbaseline_prev=0;;
laserdad 4:3aee2ca931b8 184 uint32_t Rbaseline_prev=0;;
laserdad 4:3aee2ca931b8 185 uint32_t IRbaseline=0;
laserdad 4:3aee2ca931b8 186 uint32_t Rbaseline=0;
laserdad 4:3aee2ca931b8 187 uint32_t prevBaseline=0;
laserdad 2:ee175f471ecb 188 i2c.frequency( 400000 );
laserdad 0:e9ae48b7f6f6 189 char valid;
laserdad 4:3aee2ca931b8 190 uint32_t ps_ls_data[7];
laserdad 2:ee175f471ecb 191 char samples2Read = 4; //samples, e.g. 4 samples * 3 bytes = 12 bytes (or 2 SpO2 samples)
laserdad 2:ee175f471ecb 192 char fifoBuffer[samples2Read*3];
laserdad 0:e9ae48b7f6f6 193 uint32_t ppgData[samples2Read];
laserdad 0:e9ae48b7f6f6 194
laserdad 1:fb6b2b4d5d8a 195
laserdad 1:fb6b2b4d5d8a 196 pc.printf("register settings\r\n");
laserdad 1:fb6b2b4d5d8a 197 regDump(OB1203_ADDR,0,19);
laserdad 1:fb6b2b4d5d8a 198 regDump(OB1203_ADDR,20,39);
laserdad 1:fb6b2b4d5d8a 199 regDump(OB1203_ADDR,40,59);
laserdad 1:fb6b2b4d5d8a 200 regDump(OB1203_ADDR,60,77);
laserdad 1:fb6b2b4d5d8a 201
laserdad 1:fb6b2b4d5d8a 202 pc.printf("do initial config\r\n");
laserdad 0:e9ae48b7f6f6 203 defaultConfig(); //rgb ps
laserdad 1:fb6b2b4d5d8a 204
laserdad 1:fb6b2b4d5d8a 205 pc.printf("print new register config\r\n");
laserdad 1:fb6b2b4d5d8a 206 regDump(OB1203_ADDR,0,19);
laserdad 1:fb6b2b4d5d8a 207 regDump(OB1203_ADDR,20,39);
laserdad 1:fb6b2b4d5d8a 208 regDump(OB1203_ADDR,40,59);
laserdad 1:fb6b2b4d5d8a 209 regDump(OB1203_ADDR,60,77);
laserdad 1:fb6b2b4d5d8a 210
laserdad 0:e9ae48b7f6f6 211
laserdad 0:e9ae48b7f6f6 212 intb.fall(&intEvent);
laserdad 3:d3a1fc19bee6 213 t.start();
laserdad 5:ebe305e08430 214
laserdad 0:e9ae48b7f6f6 215 while(1)
laserdad 0:e9ae48b7f6f6 216 {
laserdad 1:fb6b2b4d5d8a 217 if(mode)
laserdad 0:e9ae48b7f6f6 218 {
laserdad 2:ee175f471ecb 219 if(!intb.read())
laserdad 2:ee175f471ecb 220 {
laserdad 4:3aee2ca931b8 221 if(!afull)
laserdad 4:3aee2ca931b8 222 {
laserdad 4:3aee2ca931b8 223 numInts++; //get data every other interrupt if ppg new data interrupt mode
laserdad 4:3aee2ca931b8 224 }
laserdad 4:3aee2ca931b8 225 else
laserdad 4:3aee2ca931b8 226 {
laserdad 4:3aee2ca931b8 227 numInts = samples2Read;
laserdad 4:3aee2ca931b8 228 }
laserdad 2:ee175f471ecb 229 intFlagged = 1;
laserdad 4:3aee2ca931b8 230 if( (numInts < samples2Read) && !afull)
laserdad 4:3aee2ca931b8 231 {
laserdad 4:3aee2ca931b8 232 ob1203.get_status();
laserdad 4:3aee2ca931b8 233 }
laserdad 4:3aee2ca931b8 234 else if(intFlagged && (numInts==samples2Read) )
laserdad 3:d3a1fc19bee6 235 {
laserdad 4:3aee2ca931b8 236 numInts = 0;
laserdad 4:3aee2ca931b8 237 ob1203.getFifoSamples(samples2Read,fifoBuffer);
laserdad 4:3aee2ca931b8 238 // for (int n=0;n<samples2Read*3;n++)
laserdad 4:3aee2ca931b8 239 // {
laserdad 4:3aee2ca931b8 240 // pc.printf("%02X ",fifoBuffer[n]);
laserdad 4:3aee2ca931b8 241 // }
laserdad 4:3aee2ca931b8 242 // pc.printf("\r\n");
laserdad 4:3aee2ca931b8 243 ob1203.parseFifoSamples(samples2Read,fifoBuffer,ppgData);
laserdad 4:3aee2ca931b8 244 // for (int n=0;n<samples2Read;n++)
laserdad 4:3aee2ca931b8 245 // {
laserdad 4:3aee2ca931b8 246 // pc.printf("%d ",ppgData[n]);
laserdad 4:3aee2ca931b8 247 // }
laserdad 4:3aee2ca931b8 248 // pc.printf("\r\n");
laserdad 4:3aee2ca931b8 249 if(first) //populate average and baseline buffers the first time we run
laserdad 3:d3a1fc19bee6 250 {
laserdad 4:3aee2ca931b8 251 for(int n=0;n<running_avg;n++)
laserdad 4:3aee2ca931b8 252 {
laserdad 4:3aee2ca931b8 253 IR_avg_buffer[n] = ppgData[0];
laserdad 4:3aee2ca931b8 254 IRavg += IR_avg_buffer[n];
laserdad 4:3aee2ca931b8 255 if(spo2)
laserdad 4:3aee2ca931b8 256 {
laserdad 4:3aee2ca931b8 257 R_avg_buffer[n] = ppgData[1];
laserdad 4:3aee2ca931b8 258 Ravg += R_avg_buffer[n];
laserdad 4:3aee2ca931b8 259 }
laserdad 4:3aee2ca931b8 260
laserdad 4:3aee2ca931b8 261 }
laserdad 4:3aee2ca931b8 262 for( int n=0;n<running_baseline;n++)
laserdad 4:3aee2ca931b8 263 {
laserdad 4:3aee2ca931b8 264 // IR_baseline_buffer[n] = ppgData[0];
laserdad 4:3aee2ca931b8 265 IR_baseline_buffer[n] = 0;
laserdad 4:3aee2ca931b8 266 if(spo2)
laserdad 4:3aee2ca931b8 267 {
laserdad 4:3aee2ca931b8 268 // R_baseline_buffer[n] = ppgData[1];
laserdad 4:3aee2ca931b8 269 R_baseline_buffer[n] = 0;
laserdad 4:3aee2ca931b8 270 }
laserdad 4:3aee2ca931b8 271 }
laserdad 4:3aee2ca931b8 272 first = 0;
laserdad 4:3aee2ca931b8 273 // IRbaseline = running_baseline*ppgData[0];
laserdad 4:3aee2ca931b8 274 // Rbaseline = running_baseline*ppgData[1];
laserdad 4:3aee2ca931b8 275 }
laserdad 4:3aee2ca931b8 276
laserdad 4:3aee2ca931b8 277 // IRbaseline = running_baseline*ppgData[0];
laserdad 4:3aee2ca931b8 278 for (int n=0;n<samples2Read/2;n++)
laserdad 4:3aee2ca931b8 279 {
laserdad 4:3aee2ca931b8 280 ( avg_ptr+1 == running_avg ) ? avg_ptr = 0 : avg_ptr++;
laserdad 4:3aee2ca931b8 281 ( baseline_ptr+1 == running_baseline) ? baseline_ptr = 0 : baseline_ptr++;
laserdad 4:3aee2ca931b8 282 IRprev = IR_avg_buffer[avg_ptr]; //load the sample you are about to write over
laserdad 4:3aee2ca931b8 283 IR_avg_buffer[avg_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 4:3aee2ca931b8 284 IRavg += (IR_avg_buffer[avg_ptr] - IRprev); //update the average by removing the old sample and adding the new
laserdad 4:3aee2ca931b8 285
laserdad 4:3aee2ca931b8 286 IRbaseline_prev = IR_baseline_buffer[baseline_ptr]; //load the sample you are about to write over
laserdad 4:3aee2ca931b8 287 IR_baseline_buffer[baseline_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 4:3aee2ca931b8 288 IRbaseline += (IR_baseline_buffer[baseline_ptr] - IRbaseline_prev); //update the average by removing the old sample and adding the new
laserdad 4:3aee2ca931b8 289
laserdad 3:d3a1fc19bee6 290 if(spo2)
laserdad 3:d3a1fc19bee6 291 {
laserdad 4:3aee2ca931b8 292 Rprev = R_avg_buffer[avg_ptr];
laserdad 4:3aee2ca931b8 293 R_avg_buffer[avg_ptr] = ppgData[2*n+1];
laserdad 4:3aee2ca931b8 294 Ravg += (R_avg_buffer[avg_ptr] - Rprev);
laserdad 4:3aee2ca931b8 295 // pc.printf("%d, %d, %d\r\n",t.read_us(),ppgData[2*n],ppgData[2*n+1]);
laserdad 4:3aee2ca931b8 296 // 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 297
laserdad 4:3aee2ca931b8 298 Rbaseline_prev = R_baseline_buffer[baseline_ptr];
laserdad 4:3aee2ca931b8 299 R_baseline_buffer[baseline_ptr] = ppgData[2*n+1];
laserdad 4:3aee2ca931b8 300 Rbaseline += (R_baseline_buffer[baseline_ptr] - Rbaseline_prev);
laserdad 4:3aee2ca931b8 301
laserdad 4:3aee2ca931b8 302
laserdad 4:3aee2ca931b8 303 pc.printf("%d,%d\r\n",IRavg/running_avg,Ravg/running_avg);
laserdad 4:3aee2ca931b8 304 // pc.printf("%d,%d\r\n",IRavg/running_avg-IRbaseline/running_baseline, Ravg/running_avg-Rbaseline/running_baseline);
laserdad 4:3aee2ca931b8 305
laserdad 4:3aee2ca931b8 306 // pc.printf("%d,%d,%d,%d\r\n",Ravg/running_avg,Rbaseline/running_baseline,Rbaseline_prev,Ravg/running_avg-Rbaseline/running_baseline);
laserdad 3:d3a1fc19bee6 307 }
laserdad 4:3aee2ca931b8 308 else
laserdad 4:3aee2ca931b8 309 {
laserdad 4:3aee2ca931b8 310 ( avg_ptr+1 == running_avg ) ? avg_ptr = 0 : avg_ptr++;
laserdad 4:3aee2ca931b8 311 ( baseline_ptr+1 == running_baseline) ? baseline_ptr = 0 : baseline_ptr++;
laserdad 4:3aee2ca931b8 312 IRprev = IR_avg_buffer[avg_ptr];
laserdad 4:3aee2ca931b8 313 IR_avg_buffer[avg_ptr] = ppgData[2*n+1];
laserdad 4:3aee2ca931b8 314 prevAvg = IRavg;
laserdad 4:3aee2ca931b8 315 IRavg += (IR_avg_buffer[avg_ptr] - IRprev);
laserdad 4:3aee2ca931b8 316
laserdad 4:3aee2ca931b8 317 IRbaseline_prev = IR_baseline_buffer[baseline_ptr]; //load the sample you are about to write over
laserdad 4:3aee2ca931b8 318 IR_baseline_buffer[baseline_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 4:3aee2ca931b8 319 prevBaseline = IRbaseline;
laserdad 4:3aee2ca931b8 320 IRbaseline += (IR_baseline_buffer[baseline_ptr] - IRbaseline_prev); //update the average by removing the old sample and adding the new
laserdad 4:3aee2ca931b8 321
laserdad 4:3aee2ca931b8 322 pc.printf("%d\r\n%d\r\n",prevAvg/running_avg-prevBaseline/running_baseline,IRavg/running_avg-IRbaseline/running_baseline);
laserdad 4:3aee2ca931b8 323
laserdad 4:3aee2ca931b8 324 // pc.printf("%d\r\n%d\r\n",ppgData[2*n],ppgData[2*n+1]);
laserdad 4:3aee2ca931b8 325
laserdad 4:3aee2ca931b8 326 }
laserdad 3:d3a1fc19bee6 327 }
laserdad 4:3aee2ca931b8 328 intFlagged = 0;
laserdad 3:d3a1fc19bee6 329 }
laserdad 4:3aee2ca931b8 330 } //end if !intb
laserdad 4:3aee2ca931b8 331 }// end mode
laserdad 0:e9ae48b7f6f6 332 else
laserdad 0:e9ae48b7f6f6 333 {
laserdad 1:fb6b2b4d5d8a 334 wait_ms(sample_delay);
laserdad 5:ebe305e08430 335 if( meas_ps ? ob1203.psIsNew() : ob1203.lsIsNew() )
laserdad 1:fb6b2b4d5d8a 336 {
laserdad 5:ebe305e08430 337 meas_ps ? valid = ob1203.get_ps_ls_data(ps_ls_data) : valid = ob1203.get_ls_data(ps_ls_data);
laserdad 5:ebe305e08430 338 if (meas_temp)
laserdad 5:ebe305e08430 339 {
laserdad 5:ebe305e08430 340 ob1203.setMainConfig();
laserdad 5:ebe305e08430 341 }
laserdad 4:3aee2ca931b8 342 // 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 5:ebe305e08430 343 pc.printf("%d %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],ps_ls_data[6]);
laserdad 4:3aee2ca931b8 344
laserdad 1:fb6b2b4d5d8a 345 }
laserdad 2:ee175f471ecb 346 // else
laserdad 2:ee175f471ecb 347 // {
laserdad 2:ee175f471ecb 348 // pc.printf("status = %04X\r\n",ob1203.get_status() );
laserdad 2:ee175f471ecb 349 // }
laserdad 0:e9ae48b7f6f6 350 }
laserdad 1:fb6b2b4d5d8a 351 }//end while
laserdad 1:fb6b2b4d5d8a 352 }//end main