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@3:d3a1fc19bee6, 2018-05-09 (annotated)

Committer:
laserdad
Date:
Wed May 09 20:44:12 2018 +0000
Revision:
3:d3a1fc19bee6
Parent:
2:ee175f471ecb
Child:
4:3aee2ca931b8
latest version with averaging

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 0:e9ae48b7f6f6 4
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 0:e9ae48b7f6f6 10 InterruptIn intb(intb_pin);
laserdad 0:e9ae48b7f6f6 11 DigitalOut sda_pullup(D11,1);
laserdad 0:e9ae48b7f6f6 12 DigitalOut scl_pullup(D12,1);
laserdad 0:e9ae48b7f6f6 13 DigitalOut intb_pullup(D13,1);
laserdad 0:e9ae48b7f6f6 14
laserdad 0:e9ae48b7f6f6 15 OB1203 ob1203(&i2c);
laserdad 2:ee175f471ecb 16 Serial pc(USBTX, USBRX,256000);
laserdad 0:e9ae48b7f6f6 17 Timer t;
laserdad 0:e9ae48b7f6f6 18
laserdad 2:ee175f471ecb 19 int sample_delay = 25; //ms
laserdad 1:fb6b2b4d5d8a 20
laserdad 1:fb6b2b4d5d8a 21
laserdad 3:d3a1fc19bee6 22 bool mode = 1; //0 for PS_LS, 1 for PPG
laserdad 3:d3a1fc19bee6 23 bool spo2 = 1; //0 for HR, 1 for SpO2
laserdad 0:e9ae48b7f6f6 24 bool intFlagged =0;
laserdad 0:e9ae48b7f6f6 25
laserdad 1:fb6b2b4d5d8a 26
laserdad 0:e9ae48b7f6f6 27 void defaultConfig()
laserdad 0:e9ae48b7f6f6 28 {
laserdad 1:fb6b2b4d5d8a 29 ob1203.ls_rate = LS_RATE(2); //100ms
laserdad 0:e9ae48b7f6f6 30 ob1203.ls_res = LS_RES(2); //18bit 100ms
laserdad 1:fb6b2b4d5d8a 31 ob1203.ls_gain = LS_GAIN(1); //gain 3 default (range)
laserdad 1:fb6b2b4d5d8a 32 ob1203.ls_thres_hi = 0x000FFFFF;
laserdad 0:e9ae48b7f6f6 33 ob1203.ls_thres_lo = 0;
laserdad 0:e9ae48b7f6f6 34 ob1203.ls_sai = LS_SAI_OFF;
laserdad 0:e9ae48b7f6f6 35 ob1203.ls_mode = RGB_MODE;
laserdad 0:e9ae48b7f6f6 36 ob1203.ls_en = LS_ON;
laserdad 0:e9ae48b7f6f6 37
laserdad 0:e9ae48b7f6f6 38 ob1203.ps_sai_en = PS_SAI_OFF;
laserdad 1:fb6b2b4d5d8a 39 if(mode)
laserdad 1:fb6b2b4d5d8a 40 {
laserdad 3:d3a1fc19bee6 41 if (spo2)
laserdad 3:d3a1fc19bee6 42 {
laserdad 3:d3a1fc19bee6 43 ob1203.ppg_ps_mode = SPO2_MODE;
laserdad 3:d3a1fc19bee6 44 }
laserdad 3:d3a1fc19bee6 45 else
laserdad 3:d3a1fc19bee6 46 {
laserdad 3:d3a1fc19bee6 47 ob1203.ppg_ps_mode = HR_MODE;
laserdad 3:d3a1fc19bee6 48 }
laserdad 3:d3a1fc19bee6 49
laserdad 1:fb6b2b4d5d8a 50 }
laserdad 1:fb6b2b4d5d8a 51 else
laserdad 1:fb6b2b4d5d8a 52 {
laserdad 1:fb6b2b4d5d8a 53 ob1203.ppg_ps_mode = PS_MODE;
laserdad 1:fb6b2b4d5d8a 54 }
laserdad 1:fb6b2b4d5d8a 55 ob1203.ps_pulses = PS_PULSES(2);
laserdad 1:fb6b2b4d5d8a 56 // pc.printf("ps_pulses = %02X\r\n",ob1203.ps_pulses);
laserdad 3:d3a1fc19bee6 57 ob1203.ps_pwidth = PS_PWIDTH(4);
laserdad 3:d3a1fc19bee6 58 ob1203.ps_rate = PS_RATE(3);
laserdad 1:fb6b2b4d5d8a 59 // pc.printf("ps_rate = %02X\r\n",ob1203.ps_rate);
laserdad 0:e9ae48b7f6f6 60 ob1203.ps_avg_en = PS_AVG_OFF;
laserdad 0:e9ae48b7f6f6 61 ob1203.ps_can_ana = PS_CAN_ANA_0;
laserdad 0:e9ae48b7f6f6 62 ob1203.ps_digital_can = 0;
laserdad 0:e9ae48b7f6f6 63 ob1203.ps_hys_level = 0;
laserdad 0:e9ae48b7f6f6 64 ob1203.ps_current = 0x3FF;
laserdad 0:e9ae48b7f6f6 65 ob1203.ps_thres_hi = 0xFF;
laserdad 0:e9ae48b7f6f6 66 ob1203.ps_thres_lo = 0x00;
laserdad 0:e9ae48b7f6f6 67
laserdad 0:e9ae48b7f6f6 68 //interrupts
laserdad 0:e9ae48b7f6f6 69 ob1203.ls_int_sel = LS_INT_SEL_W;
laserdad 0:e9ae48b7f6f6 70 ob1203.ls_var_mode = LS_THRES_INT_MODE;
laserdad 0:e9ae48b7f6f6 71 ob1203.ls_int_en = LS_INT_ON;
laserdad 0:e9ae48b7f6f6 72 ob1203.ppg_ps_en = PPG_PS_ON;
laserdad 0:e9ae48b7f6f6 73 ob1203.afull_int_en = AFULL_INT_ON;
laserdad 0:e9ae48b7f6f6 74 ob1203.ppg_int_en = PPG_INT_OFF;
laserdad 0:e9ae48b7f6f6 75 ob1203.ps_logic_mode = PS_INT_READ_CLEARS;
laserdad 0:e9ae48b7f6f6 76 ob1203.ps_int_en = PS_INT_ON;
laserdad 0:e9ae48b7f6f6 77 ob1203.ls_persist = LS_PERSIST(2);
laserdad 0:e9ae48b7f6f6 78 ob1203.ps_persist = PS_PERSIST(2);
laserdad 0:e9ae48b7f6f6 79
laserdad 0:e9ae48b7f6f6 80 //PPG
laserdad 3:d3a1fc19bee6 81 ob1203.ir_current = 0x1FF;
laserdad 3:d3a1fc19bee6 82 if (spo2)
laserdad 3:d3a1fc19bee6 83 {
laserdad 3:d3a1fc19bee6 84 ob1203.r_current = 0x1FF;
laserdad 3:d3a1fc19bee6 85 }
laserdad 3:d3a1fc19bee6 86 else
laserdad 3:d3a1fc19bee6 87 {
laserdad 3:d3a1fc19bee6 88 ob1203.r_current = 0;
laserdad 3:d3a1fc19bee6 89 }
laserdad 0:e9ae48b7f6f6 90 ob1203.ppg_ps_gain = PPG_PS_GAIN_2;
laserdad 0:e9ae48b7f6f6 91 ob1203.ppg_pow_save = PPG_POW_SAVE_OFF;
laserdad 0:e9ae48b7f6f6 92 ob1203.led_flip = LED_FLIP_OFF;
laserdad 0:e9ae48b7f6f6 93 ob1203.ch1_can_ana = PPG_CH1_CAN(0);
laserdad 0:e9ae48b7f6f6 94 ob1203.ch2_can_ana = PPG_CH2_CAN(0);
laserdad 3:d3a1fc19bee6 95 ob1203.ppg_avg = PPG_AVG(3);
laserdad 3:d3a1fc19bee6 96 ob1203.ppg_rate = PPG_RATE(1);
laserdad 3:d3a1fc19bee6 97 ob1203.ppg_pwidth = PPG_PWIDTH(3);
laserdad 0:e9ae48b7f6f6 98 ob1203.ppg_freq = PPG_FREQ_60HZ;
laserdad 2:ee175f471ecb 99 // ob1203.ppg_freq = PPG_FREQ_50HZ;
laserdad 3:d3a1fc19bee6 100
laserdad 0:e9ae48b7f6f6 101 ob1203.fifo_rollover_en = FIFO_ROLL_ON;
laserdad 0:e9ae48b7f6f6 102 ob1203.fifo_afull_samples_left = AFULL_SAMPLES_LEFT(8);
laserdad 0:e9ae48b7f6f6 103
laserdad 0:e9ae48b7f6f6 104 if(mode)
laserdad 0:e9ae48b7f6f6 105 {
laserdad 3:d3a1fc19bee6 106 if(spo2)
laserdad 3:d3a1fc19bee6 107 {
laserdad 3:d3a1fc19bee6 108 ob1203.init_spo2();
laserdad 3:d3a1fc19bee6 109 }
laserdad 3:d3a1fc19bee6 110 else
laserdad 3:d3a1fc19bee6 111 {
laserdad 3:d3a1fc19bee6 112 ob1203.init_hr();
laserdad 3:d3a1fc19bee6 113 }
laserdad 0:e9ae48b7f6f6 114 }
laserdad 0:e9ae48b7f6f6 115 else
laserdad 0:e9ae48b7f6f6 116 {
laserdad 0:e9ae48b7f6f6 117 ob1203.init_ps_rgb();
laserdad 0:e9ae48b7f6f6 118 }
laserdad 0:e9ae48b7f6f6 119 }
laserdad 0:e9ae48b7f6f6 120
laserdad 1:fb6b2b4d5d8a 121 void regDump(uint8_t Addr, uint8_t startByte, uint8_t endByte)
laserdad 1:fb6b2b4d5d8a 122 {
laserdad 1:fb6b2b4d5d8a 123 /*print the values of up to 20 registers--buffer limit, e.g.*/
laserdad 1:fb6b2b4d5d8a 124 char regData[20];
laserdad 1:fb6b2b4d5d8a 125 int numBytes;
laserdad 1:fb6b2b4d5d8a 126 if (endByte>=startByte) {
laserdad 1:fb6b2b4d5d8a 127 numBytes = (endByte-startByte+1) < 20 ? (endByte-startByte+1) : 20;
laserdad 1:fb6b2b4d5d8a 128 } else {
laserdad 1:fb6b2b4d5d8a 129 numBytes=1;
laserdad 1:fb6b2b4d5d8a 130 }
laserdad 1:fb6b2b4d5d8a 131
laserdad 1:fb6b2b4d5d8a 132 regData[0] = startByte;
laserdad 1:fb6b2b4d5d8a 133 i2c.write(Addr,regData,1,true);
laserdad 1:fb6b2b4d5d8a 134 i2c.read(Addr, regData, numBytes);
laserdad 1:fb6b2b4d5d8a 135 for(int n=0; n<numBytes; n++) {
laserdad 1:fb6b2b4d5d8a 136 pc.printf("%02X, %02X \r\n", startByte+n, regData[n]);
laserdad 1:fb6b2b4d5d8a 137 }
laserdad 1:fb6b2b4d5d8a 138 }
laserdad 1:fb6b2b4d5d8a 139
laserdad 0:e9ae48b7f6f6 140
laserdad 0:e9ae48b7f6f6 141 void intEvent(void)
laserdad 0:e9ae48b7f6f6 142 {
laserdad 0:e9ae48b7f6f6 143 intFlagged = 1;
laserdad 0:e9ae48b7f6f6 144 }
laserdad 0:e9ae48b7f6f6 145
laserdad 0:e9ae48b7f6f6 146 int main()
laserdad 0:e9ae48b7f6f6 147 {
laserdad 3:d3a1fc19bee6 148 uint32_t running_avg = 8;
laserdad 3:d3a1fc19bee6 149 char avg_ptr = 0;
laserdad 3:d3a1fc19bee6 150 int first = 1;
laserdad 3:d3a1fc19bee6 151 uint32_t IRavg = 0;
laserdad 3:d3a1fc19bee6 152 uint32_t Ravg = 0;
laserdad 3:d3a1fc19bee6 153 uint32_t IRprev = 0;
laserdad 3:d3a1fc19bee6 154 uint32_t Rprev = 0;
laserdad 3:d3a1fc19bee6 155 uint32_t prevAvg = 0;
laserdad 3:d3a1fc19bee6 156 uint32_t IR_avg_buffer[running_avg];
laserdad 3:d3a1fc19bee6 157 uint32_t R_avg_buffer[running_avg];
laserdad 2:ee175f471ecb 158 i2c.frequency( 400000 );
laserdad 0:e9ae48b7f6f6 159 char valid;
laserdad 0:e9ae48b7f6f6 160 uint32_t ps_ls_data[6];
laserdad 2:ee175f471ecb 161 char samples2Read = 4; //samples, e.g. 4 samples * 3 bytes = 12 bytes (or 2 SpO2 samples)
laserdad 2:ee175f471ecb 162 char fifoBuffer[samples2Read*3];
laserdad 0:e9ae48b7f6f6 163 uint32_t ppgData[samples2Read];
laserdad 0:e9ae48b7f6f6 164
laserdad 1:fb6b2b4d5d8a 165
laserdad 1:fb6b2b4d5d8a 166 pc.printf("register settings\r\n");
laserdad 1:fb6b2b4d5d8a 167 regDump(OB1203_ADDR,0,19);
laserdad 1:fb6b2b4d5d8a 168 regDump(OB1203_ADDR,20,39);
laserdad 1:fb6b2b4d5d8a 169 regDump(OB1203_ADDR,40,59);
laserdad 1:fb6b2b4d5d8a 170 regDump(OB1203_ADDR,60,77);
laserdad 1:fb6b2b4d5d8a 171
laserdad 1:fb6b2b4d5d8a 172 pc.printf("do initial config\r\n");
laserdad 0:e9ae48b7f6f6 173 defaultConfig(); //rgb ps
laserdad 1:fb6b2b4d5d8a 174
laserdad 1:fb6b2b4d5d8a 175 pc.printf("print new register config\r\n");
laserdad 1:fb6b2b4d5d8a 176 regDump(OB1203_ADDR,0,19);
laserdad 1:fb6b2b4d5d8a 177 regDump(OB1203_ADDR,20,39);
laserdad 1:fb6b2b4d5d8a 178 regDump(OB1203_ADDR,40,59);
laserdad 1:fb6b2b4d5d8a 179 regDump(OB1203_ADDR,60,77);
laserdad 1:fb6b2b4d5d8a 180
laserdad 0:e9ae48b7f6f6 181
laserdad 0:e9ae48b7f6f6 182 intb.fall(&intEvent);
laserdad 3:d3a1fc19bee6 183 t.start();
laserdad 0:e9ae48b7f6f6 184 while(1)
laserdad 0:e9ae48b7f6f6 185 {
laserdad 1:fb6b2b4d5d8a 186 if(mode)
laserdad 0:e9ae48b7f6f6 187 {
laserdad 2:ee175f471ecb 188 if(!intb.read())
laserdad 2:ee175f471ecb 189 {
laserdad 2:ee175f471ecb 190 intFlagged = 1;
laserdad 2:ee175f471ecb 191 }
laserdad 1:fb6b2b4d5d8a 192 if(intFlagged)
laserdad 0:e9ae48b7f6f6 193 {
laserdad 1:fb6b2b4d5d8a 194
laserdad 1:fb6b2b4d5d8a 195 ob1203.getFifoSamples(samples2Read,fifoBuffer);
laserdad 2:ee175f471ecb 196 // for (int n=0;n<samples2Read*3;n++)
laserdad 2:ee175f471ecb 197 // {
laserdad 2:ee175f471ecb 198 // pc.printf("%02X ",fifoBuffer[n]);
laserdad 2:ee175f471ecb 199 // }
laserdad 2:ee175f471ecb 200 // pc.printf("\r\n");
laserdad 1:fb6b2b4d5d8a 201 ob1203.parseFifoSamples(samples2Read,fifoBuffer,ppgData);
laserdad 2:ee175f471ecb 202 // for (int n=0;n<samples2Read;n++)
laserdad 2:ee175f471ecb 203 // {
laserdad 2:ee175f471ecb 204 // pc.printf("%d ",ppgData[n]);
laserdad 2:ee175f471ecb 205 // }
laserdad 2:ee175f471ecb 206 // pc.printf("\r\n");
laserdad 3:d3a1fc19bee6 207 if(first) //populate average buffers the first time we run
laserdad 3:d3a1fc19bee6 208 {
laserdad 3:d3a1fc19bee6 209 for(int n=0;n<running_avg;n++)
laserdad 3:d3a1fc19bee6 210 {
laserdad 3:d3a1fc19bee6 211 IR_avg_buffer[n] = ppgData[0];
laserdad 3:d3a1fc19bee6 212 IRavg += IR_avg_buffer[n];
laserdad 3:d3a1fc19bee6 213 if(spo2)
laserdad 3:d3a1fc19bee6 214 {
laserdad 3:d3a1fc19bee6 215 R_avg_buffer[n] = ppgData[1];
laserdad 3:d3a1fc19bee6 216 Ravg += R_avg_buffer[n];
laserdad 3:d3a1fc19bee6 217 }
laserdad 3:d3a1fc19bee6 218
laserdad 3:d3a1fc19bee6 219 }
laserdad 3:d3a1fc19bee6 220 first = 0;
laserdad 3:d3a1fc19bee6 221 }
laserdad 3:d3a1fc19bee6 222
laserdad 1:fb6b2b4d5d8a 223 for (int n=0;n<samples2Read/2;n++)
laserdad 1:fb6b2b4d5d8a 224 {
laserdad 3:d3a1fc19bee6 225 ( avg_ptr+1 == running_avg ) ? avg_ptr = 0 : avg_ptr++;
laserdad 3:d3a1fc19bee6 226 IRprev = IR_avg_buffer[avg_ptr]; //load the sample you are about to write over
laserdad 3:d3a1fc19bee6 227 IR_avg_buffer[avg_ptr] = ppgData[2*n]; //load the new sample in the buffer
laserdad 3:d3a1fc19bee6 228 IRavg += (IR_avg_buffer[avg_ptr] - IRprev); //update the average by removing the old sample and adding the new
laserdad 3:d3a1fc19bee6 229 if(spo2)
laserdad 3:d3a1fc19bee6 230 {
laserdad 3:d3a1fc19bee6 231 Rprev = R_avg_buffer[avg_ptr];
laserdad 3:d3a1fc19bee6 232 R_avg_buffer[avg_ptr] = ppgData[2*n+1];
laserdad 3:d3a1fc19bee6 233 Ravg += (R_avg_buffer[avg_ptr] - Rprev);
laserdad 3:d3a1fc19bee6 234 // pc.printf("%d, %d, %d\r\n",t.read_us(),ppgData[2*n],ppgData[2*n+1]);
laserdad 3:d3a1fc19bee6 235 // 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 3:d3a1fc19bee6 236 pc.printf("%d,%d\r\n",IRavg/running_avg,Ravg/running_avg);
laserdad 3:d3a1fc19bee6 237 }
laserdad 3:d3a1fc19bee6 238 else
laserdad 3:d3a1fc19bee6 239 {
laserdad 3:d3a1fc19bee6 240 ( avg_ptr+1 == running_avg ) ? avg_ptr = 0 : avg_ptr++;
laserdad 3:d3a1fc19bee6 241 IRprev = IR_avg_buffer[avg_ptr];
laserdad 3:d3a1fc19bee6 242 IR_avg_buffer[avg_ptr] = ppgData[2*n+1];
laserdad 3:d3a1fc19bee6 243 prevAvg = IRavg;
laserdad 3:d3a1fc19bee6 244 IRavg += (IR_avg_buffer[avg_ptr] - IRprev);
laserdad 3:d3a1fc19bee6 245 pc.printf("%d\r\n%d\r\n",prevAvg/running_avg,IRavg/running_avg);
laserdad 3:d3a1fc19bee6 246 // pc.printf("%d\r\n%d\r\n",ppgData[2*n],ppgData[2*n+1]);
laserdad 3:d3a1fc19bee6 247
laserdad 3:d3a1fc19bee6 248 }
laserdad 1:fb6b2b4d5d8a 249 }
laserdad 1:fb6b2b4d5d8a 250 intFlagged = 0;
laserdad 1:fb6b2b4d5d8a 251
laserdad 0:e9ae48b7f6f6 252 }
laserdad 0:e9ae48b7f6f6 253 }
laserdad 0:e9ae48b7f6f6 254 else
laserdad 0:e9ae48b7f6f6 255 {
laserdad 1:fb6b2b4d5d8a 256 wait_ms(sample_delay);
laserdad 1:fb6b2b4d5d8a 257 if(ob1203.dataIsNew())
laserdad 1:fb6b2b4d5d8a 258 {
laserdad 1:fb6b2b4d5d8a 259 valid = ob1203.get_ps_ls_data(ps_ls_data);
laserdad 1:fb6b2b4d5d8a 260 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 1:fb6b2b4d5d8a 261 }
laserdad 2:ee175f471ecb 262 // else
laserdad 2:ee175f471ecb 263 // {
laserdad 2:ee175f471ecb 264 // pc.printf("status = %04X\r\n",ob1203.get_status() );
laserdad 2:ee175f471ecb 265 // }
laserdad 0:e9ae48b7f6f6 266 }
laserdad 1:fb6b2b4d5d8a 267 }//end while
laserdad 1:fb6b2b4d5d8a 268 }//end main