OB1203 basic mbed driver
OB1203.cpp@19:a27b98998edf, 2018-10-12 (annotated)
- Committer:
- laserdad
- Date:
- Fri Oct 12 20:19:38 2018 +0000
- Revision:
- 19:a27b98998edf
- Parent:
- 16:d5fe5debb5d2
- Child:
- 20:8d69cd11b8fa
- Child:
- 25:ca9caacd0f9f
working--added AGC functions
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
laserdad | 0:2da1f69b38fd | 1 | #include "OB1203.h" |
laserdad | 0:2da1f69b38fd | 2 | #include "mbed.h" |
laserdad | 0:2da1f69b38fd | 3 | |
laserdad | 0:2da1f69b38fd | 4 | extern Serial pc; |
laserdad | 0:2da1f69b38fd | 5 | |
laserdad | 19:a27b98998edf | 6 | // // |
laserdad | 19:a27b98998edf | 7 | OB1203::OB1203(I2C *i2c_obj) |
laserdad | 0:2da1f69b38fd | 8 | { |
laserdad | 0:2da1f69b38fd | 9 | i2c = i2c_obj; |
laserdad | 0:2da1f69b38fd | 10 | } |
laserdad | 0:2da1f69b38fd | 11 | |
laserdad | 0:2da1f69b38fd | 12 | |
laserdad | 0:2da1f69b38fd | 13 | void OB1203::reset() |
laserdad | 0:2da1f69b38fd | 14 | { |
laserdad | 0:2da1f69b38fd | 15 | /*POR reset*/ |
laserdad | 0:2da1f69b38fd | 16 | writeRegister(OB1203_ADDR,REG_MAIN_CTRL_0,SW_RESET); |
laserdad | 0:2da1f69b38fd | 17 | wait_ms(POR_TIME_MS); |
laserdad | 0:2da1f69b38fd | 18 | } |
laserdad | 0:2da1f69b38fd | 19 | |
laserdad | 0:2da1f69b38fd | 20 | |
laserdad | 0:2da1f69b38fd | 21 | void OB1203::writeRegister(int addr, char reg, char val) { |
laserdad | 0:2da1f69b38fd | 22 | /*writes 1 byte to a single register*/ |
laserdad | 0:2da1f69b38fd | 23 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 24 | writeData[0] = reg; |
laserdad | 0:2da1f69b38fd | 25 | writeData[1] = val; |
laserdad | 0:2da1f69b38fd | 26 | i2c->write(addr,writeData, 2); |
laserdad | 0:2da1f69b38fd | 27 | } |
laserdad | 0:2da1f69b38fd | 28 | |
laserdad | 0:2da1f69b38fd | 29 | |
laserdad | 0:2da1f69b38fd | 30 | void OB1203::writeBlock(int addr, char startReg, char *data, char numBytes) { |
laserdad | 0:2da1f69b38fd | 31 | /*writes data from an array beginning at the startReg*/ |
laserdad | 1:99ca9c464503 | 32 | // pc.printf("entering writeBlock with data %02x %02x\r\n",data[0],data[1]); |
laserdad | 0:2da1f69b38fd | 33 | char writeData[numBytes+1]; |
laserdad | 0:2da1f69b38fd | 34 | writeData[0]=startReg; |
laserdad | 0:2da1f69b38fd | 35 | for(int n=1;n<numBytes+1;n++) { |
laserdad | 0:2da1f69b38fd | 36 | writeData[n]=data[n-1]; |
laserdad | 0:2da1f69b38fd | 37 | } |
laserdad | 0:2da1f69b38fd | 38 | i2c->write(addr,writeData,numBytes+1); |
laserdad | 0:2da1f69b38fd | 39 | } |
laserdad | 0:2da1f69b38fd | 40 | |
laserdad | 0:2da1f69b38fd | 41 | |
laserdad | 0:2da1f69b38fd | 42 | void OB1203::readBlock(int addr, char startReg, char *data, int numBytes) |
laserdad | 0:2da1f69b38fd | 43 | { |
laserdad | 0:2da1f69b38fd | 44 | char writeData[1]; |
laserdad | 0:2da1f69b38fd | 45 | writeData[0] = startReg; |
laserdad | 0:2da1f69b38fd | 46 | i2c->write(addr,writeData,1,true); |
laserdad | 0:2da1f69b38fd | 47 | i2c->read(addr,data,numBytes); |
laserdad | 4:f25ca600a0e6 | 48 | // wait_us(800); |
laserdad | 4:f25ca600a0e6 | 49 | // for(int n=0;n<numBytes;n++) |
laserdad | 4:f25ca600a0e6 | 50 | // { |
laserdad | 4:f25ca600a0e6 | 51 | // i2c->read(addr,data+n,1,1); |
laserdad | 4:f25ca600a0e6 | 52 | // wait_us(20); |
laserdad | 4:f25ca600a0e6 | 53 | // } |
laserdad | 0:2da1f69b38fd | 54 | } |
laserdad | 0:2da1f69b38fd | 55 | |
laserdad | 2:3cba0fe6db60 | 56 | uint16_t OB1203::get_status() |
laserdad | 0:2da1f69b38fd | 57 | { |
laserdad | 0:2da1f69b38fd | 58 | char writeData[1]; //declare array of size 1 |
laserdad | 0:2da1f69b38fd | 59 | writeData[0] = REG_STATUS_0; |
laserdad | 2:3cba0fe6db60 | 60 | char data[2]; //declare array of size 1 |
laserdad | 0:2da1f69b38fd | 61 | i2c->write(OB1203_ADDR,writeData,1,true); |
laserdad | 0:2da1f69b38fd | 62 | i2c->read(OB1203_ADDR,data,2); |
laserdad | 0:2da1f69b38fd | 63 | return (data[0]<<8 | data[1]); |
laserdad | 0:2da1f69b38fd | 64 | } |
laserdad | 0:2da1f69b38fd | 65 | |
laserdad | 1:99ca9c464503 | 66 | bool OB1203::dataIsNew() |
laserdad | 1:99ca9c464503 | 67 | { |
laserdad | 1:99ca9c464503 | 68 | int status_reg_vals; |
laserdad | 1:99ca9c464503 | 69 | status_reg_vals = get_status(); |
laserdad | 5:527556d05aa8 | 70 | return ((status_reg_vals & 0x0100)>>8) || (status_reg_vals & 0x0091); |
laserdad | 5:527556d05aa8 | 71 | } |
laserdad | 5:527556d05aa8 | 72 | |
laserdad | 5:527556d05aa8 | 73 | bool OB1203::lsIsNew() |
laserdad | 5:527556d05aa8 | 74 | { |
laserdad | 5:527556d05aa8 | 75 | int status_reg_vals; |
laserdad | 5:527556d05aa8 | 76 | status_reg_vals = get_status(); |
laserdad | 5:527556d05aa8 | 77 | return ((status_reg_vals & 0x0100)>>8); |
laserdad | 5:527556d05aa8 | 78 | } |
laserdad | 5:527556d05aa8 | 79 | |
laserdad | 5:527556d05aa8 | 80 | bool OB1203::psIsNew() |
laserdad | 5:527556d05aa8 | 81 | { |
laserdad | 5:527556d05aa8 | 82 | int status_reg_vals; |
laserdad | 5:527556d05aa8 | 83 | status_reg_vals = get_status(); |
laserdad | 5:527556d05aa8 | 84 | return (status_reg_vals & 0x0001); |
laserdad | 5:527556d05aa8 | 85 | } |
laserdad | 5:527556d05aa8 | 86 | |
laserdad | 5:527556d05aa8 | 87 | bool OB1203::tempIsNew() |
laserdad | 5:527556d05aa8 | 88 | { |
laserdad | 5:527556d05aa8 | 89 | int status_reg_vals; |
laserdad | 5:527556d05aa8 | 90 | status_reg_vals = get_status(); |
laserdad | 5:527556d05aa8 | 91 | return (status_reg_vals & 0x0080); |
laserdad | 5:527556d05aa8 | 92 | } |
laserdad | 5:527556d05aa8 | 93 | |
laserdad | 5:527556d05aa8 | 94 | bool OB1203::bioIsNew() |
laserdad | 5:527556d05aa8 | 95 | { |
laserdad | 5:527556d05aa8 | 96 | int status_reg_vals; |
laserdad | 5:527556d05aa8 | 97 | status_reg_vals = get_status(); |
laserdad | 5:527556d05aa8 | 98 | return (status_reg_vals & 0x0010); |
laserdad | 1:99ca9c464503 | 99 | } |
laserdad | 0:2da1f69b38fd | 100 | |
laserdad | 8:6c19c052b053 | 101 | void OB1203::setOscTrim() |
laserdad | 8:6c19c052b053 | 102 | { |
laserdad | 8:6c19c052b053 | 103 | char writeData[1]; |
laserdad | 8:6c19c052b053 | 104 | writeData[0] = osc_trim; |
laserdad | 8:6c19c052b053 | 105 | // pc.printf("writing %02x to REG %02x\r\n",osc_trim,REG_OSC_TRIM); |
laserdad | 8:6c19c052b053 | 106 | writeBlock(OB1203_ADDR,REG_OSC_TRIM,writeData,1); |
laserdad | 8:6c19c052b053 | 107 | } |
laserdad | 8:6c19c052b053 | 108 | |
laserdad | 0:2da1f69b38fd | 109 | void OB1203::setMainConfig() |
laserdad | 0:2da1f69b38fd | 110 | { |
laserdad | 0:2da1f69b38fd | 111 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 112 | writeData[0] = ls_sai | ls_mode | ls_en; //MAIN_CTRL_0 |
laserdad | 4:f25ca600a0e6 | 113 | writeData[1] = temp_en | ps_sai_en | ppg_ps_mode | ppg_ps_en; //MAIN_CTRL_1 |
laserdad | 5:527556d05aa8 | 114 | // pc.printf("main config 1 to write %02x\r\n",writeData[1]); |
laserdad | 0:2da1f69b38fd | 115 | writeBlock(OB1203_ADDR,REG_MAIN_CTRL_0,writeData,2); |
laserdad | 0:2da1f69b38fd | 116 | } |
laserdad | 0:2da1f69b38fd | 117 | |
laserdad | 0:2da1f69b38fd | 118 | |
laserdad | 0:2da1f69b38fd | 119 | void OB1203::setIntConfig() |
laserdad | 0:2da1f69b38fd | 120 | { |
laserdad | 0:2da1f69b38fd | 121 | char writeData[3]; |
laserdad | 0:2da1f69b38fd | 122 | writeData[0] = ls_int_sel | ls_var_mode | ls_int_en; |
laserdad | 0:2da1f69b38fd | 123 | writeData[1] = afull_int_en | ppg_int_en | ps_logic_mode | ps_int_en; |
laserdad | 0:2da1f69b38fd | 124 | writeData[2] = ls_persist | ps_persist; |
laserdad | 0:2da1f69b38fd | 125 | writeBlock(OB1203_ADDR,REG_INT_CFG_0,writeData,3); //default |
laserdad | 0:2da1f69b38fd | 126 | } |
laserdad | 0:2da1f69b38fd | 127 | |
laserdad | 0:2da1f69b38fd | 128 | |
laserdad | 0:2da1f69b38fd | 129 | void OB1203::setLSthresh() |
laserdad | 0:2da1f69b38fd | 130 | { |
laserdad | 0:2da1f69b38fd | 131 | char writeData[6]; |
laserdad | 0:2da1f69b38fd | 132 | writeData[0] = (char) (ls_thres_hi & 0x000000FF); |
laserdad | 0:2da1f69b38fd | 133 | writeData[1] = (char) ((ls_thres_hi & 0x0000FF00)>>8); |
laserdad | 1:99ca9c464503 | 134 | writeData[2] = (char) ((ls_thres_hi & 0x00FF0000)>>16); |
laserdad | 0:2da1f69b38fd | 135 | writeData[3] = (char) (ls_thres_lo & 0x000000FF); |
laserdad | 0:2da1f69b38fd | 136 | writeData[4] = (char) ((ls_thres_lo & 0x0000FF00)>>8); |
laserdad | 1:99ca9c464503 | 137 | writeData[5] = (char) ((ls_thres_lo & 0x00FF0000)>>16); |
laserdad | 0:2da1f69b38fd | 138 | writeBlock(OB1203_ADDR,REG_LS_THRES_HI,writeData,6); //default |
laserdad | 0:2da1f69b38fd | 139 | } |
laserdad | 0:2da1f69b38fd | 140 | |
laserdad | 0:2da1f69b38fd | 141 | |
laserdad | 0:2da1f69b38fd | 142 | void OB1203::setPSthresh() |
laserdad | 0:2da1f69b38fd | 143 | { |
laserdad | 0:2da1f69b38fd | 144 | char writeData[4]; |
laserdad | 0:2da1f69b38fd | 145 | writeData[0] = (char) (ps_thres_hi & 0x000FF); |
laserdad | 0:2da1f69b38fd | 146 | writeData[1] = (char) ((ps_thres_hi & 0xFF00)>>8); |
laserdad | 16:d5fe5debb5d2 | 147 | writeData[2] = (char) (ps_thres_lo & 0x000FF); |
laserdad | 16:d5fe5debb5d2 | 148 | writeData[3] = (char) ((ps_thres_lo & 0xFF00)>>8); |
laserdad | 0:2da1f69b38fd | 149 | writeBlock(OB1203_ADDR,REG_PS_THRES_HI,writeData,4); //default |
laserdad | 0:2da1f69b38fd | 150 | } |
laserdad | 0:2da1f69b38fd | 151 | |
laserdad | 0:2da1f69b38fd | 152 | |
laserdad | 0:2da1f69b38fd | 153 | void OB1203::setPScurrent() |
laserdad | 0:2da1f69b38fd | 154 | { |
laserdad | 0:2da1f69b38fd | 155 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 156 | writeData[0] = (char) (ps_current & 0x00FF); |
laserdad | 0:2da1f69b38fd | 157 | writeData[1] = (char) ((ps_current & 0xFF00)>>8); |
laserdad | 0:2da1f69b38fd | 158 | writeBlock(OB1203_ADDR,REG_PS_LED_CURR,writeData,2); |
laserdad | 0:2da1f69b38fd | 159 | } |
laserdad | 0:2da1f69b38fd | 160 | |
laserdad | 0:2da1f69b38fd | 161 | |
laserdad | 0:2da1f69b38fd | 162 | void OB1203::setPPGcurrent() |
laserdad | 0:2da1f69b38fd | 163 | { |
laserdad | 0:2da1f69b38fd | 164 | char writeData[4]; |
laserdad | 0:2da1f69b38fd | 165 | writeData[0] = (char) (ir_current & 0x00FF); |
laserdad | 0:2da1f69b38fd | 166 | writeData[1] = (char) ((ir_current & 0xFF00)>>8); |
laserdad | 0:2da1f69b38fd | 167 | writeData[2] = (char) (r_current & 0x00FF); |
laserdad | 0:2da1f69b38fd | 168 | writeData[3] = (char) ((r_current & 0xFF00)>>8); |
laserdad | 0:2da1f69b38fd | 169 | writeBlock(OB1203_ADDR,REG_PPG_IRLED_CURR,writeData,4); |
laserdad | 0:2da1f69b38fd | 170 | } |
laserdad | 0:2da1f69b38fd | 171 | |
laserdad | 0:2da1f69b38fd | 172 | |
laserdad | 0:2da1f69b38fd | 173 | void OB1203::setPPG_PSgain_cfg() |
laserdad | 0:2da1f69b38fd | 174 | { |
laserdad | 0:2da1f69b38fd | 175 | char writeData[2]; |
laserdad | 8:6c19c052b053 | 176 | writeData[0] = ppg_ps_gain | ppg_LED_settling | ppg_ALC_track; |
laserdad | 10:6703d2cdeabc | 177 | writeData[1] = ppg_pow_save | led_flip | sig_out | diff | alc; |
laserdad | 0:2da1f69b38fd | 178 | writeBlock(OB1203_ADDR,REG_PPG_PS_GAIN,writeData,2); |
laserdad | 0:2da1f69b38fd | 179 | } |
laserdad | 0:2da1f69b38fd | 180 | |
laserdad | 0:2da1f69b38fd | 181 | void OB1203::setPPGana_can() |
laserdad | 0:2da1f69b38fd | 182 | { |
laserdad | 0:2da1f69b38fd | 183 | char writeData[1]; |
laserdad | 0:2da1f69b38fd | 184 | writeData[0] = ch1_can_ana | ch2_can_ana; |
laserdad | 0:2da1f69b38fd | 185 | writeBlock(OB1203_ADDR,REG_PPG_CAN_ANA,writeData,1); |
laserdad | 0:2da1f69b38fd | 186 | } |
laserdad | 0:2da1f69b38fd | 187 | |
laserdad | 0:2da1f69b38fd | 188 | void OB1203::setPPGavg_and_rate() |
laserdad | 0:2da1f69b38fd | 189 | { |
laserdad | 0:2da1f69b38fd | 190 | char writeData[2]; |
laserdad | 9:0c3d2eea1c79 | 191 | writeData[0] = ppg_avg | 0x0A; //use standard LED max settings |
laserdad | 0:2da1f69b38fd | 192 | writeData[1] = ppg_pwidth | ppg_freq | ppg_rate; |
laserdad | 0:2da1f69b38fd | 193 | writeBlock(OB1203_ADDR,REG_PPG_AVG,writeData,2); |
laserdad | 0:2da1f69b38fd | 194 | } |
laserdad | 0:2da1f69b38fd | 195 | |
laserdad | 9:0c3d2eea1c79 | 196 | void OB1203::setBioTrim() |
laserdad | 9:0c3d2eea1c79 | 197 | { |
laserdad | 9:0c3d2eea1c79 | 198 | char writeData[1]; |
laserdad | 9:0c3d2eea1c79 | 199 | writeData[0] = bio_trim; |
laserdad | 9:0c3d2eea1c79 | 200 | writeBlock(OB1203_ADDR, REG_BIO_TRIM,writeData,1); |
laserdad | 9:0c3d2eea1c79 | 201 | } |
laserdad | 9:0c3d2eea1c79 | 202 | |
laserdad | 9:0c3d2eea1c79 | 203 | void OB1203::setLEDTrim() |
laserdad | 9:0c3d2eea1c79 | 204 | { |
laserdad | 9:0c3d2eea1c79 | 205 | char writeData[1]; |
laserdad | 9:0c3d2eea1c79 | 206 | writeData[0] = led_trim; |
laserdad | 9:0c3d2eea1c79 | 207 | writeBlock(OB1203_ADDR, REG_LED_TRIM,writeData,1); |
laserdad | 9:0c3d2eea1c79 | 208 | } |
laserdad | 0:2da1f69b38fd | 209 | |
laserdad | 0:2da1f69b38fd | 210 | void OB1203::setDigitalCan() |
laserdad | 0:2da1f69b38fd | 211 | { |
laserdad | 0:2da1f69b38fd | 212 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 213 | writeData[0] = (char)(ps_digital_can & 0x00FF); |
laserdad | 0:2da1f69b38fd | 214 | writeData[1] = (char)((ps_digital_can & 0xFF00)>>8); |
laserdad | 0:2da1f69b38fd | 215 | writeBlock(OB1203_ADDR,REG_PS_CAN_DIG,writeData,2); |
laserdad | 0:2da1f69b38fd | 216 | } |
laserdad | 0:2da1f69b38fd | 217 | |
laserdad | 0:2da1f69b38fd | 218 | |
laserdad | 0:2da1f69b38fd | 219 | void OB1203::setFifoConfig() |
laserdad | 0:2da1f69b38fd | 220 | { |
laserdad | 0:2da1f69b38fd | 221 | char writeData[1]; |
laserdad | 12:573f7ce91a0d | 222 | writeData[0] = fifo_rollover_en | fifo_afull_advance_warning; |
laserdad | 0:2da1f69b38fd | 223 | writeBlock(OB1203_ADDR,REG_FIFO_CFG,writeData,1); |
laserdad | 0:2da1f69b38fd | 224 | } |
laserdad | 0:2da1f69b38fd | 225 | |
laserdad | 0:2da1f69b38fd | 226 | |
laserdad | 12:573f7ce91a0d | 227 | void OB1203::resetFIFO() |
laserdad | 12:573f7ce91a0d | 228 | { |
laserdad | 12:573f7ce91a0d | 229 | char writeData[2]; |
laserdad | 12:573f7ce91a0d | 230 | writeData[0]=0; |
laserdad | 12:573f7ce91a0d | 231 | writeData[1]=0; |
laserdad | 12:573f7ce91a0d | 232 | writeBlock(OB1203_ADDR,REG_FIFO_WR_PTR,writeData,2);//set write and read pointer to zero--next sample is newest |
laserdad | 12:573f7ce91a0d | 233 | writeRegister(OB1203_ADDR,REG_MAIN_CTRL_1, (temp_en | ps_sai_en | ppg_ps_mode | 0) ); //turn PPG off MAIN_CTRL_1; |
laserdad | 12:573f7ce91a0d | 234 | writeRegister(OB1203_ADDR,REG_MAIN_CTRL_1, (temp_en | ps_sai_en | ppg_ps_mode | ppg_ps_en) ); //MAIN_CTRL_1; |
laserdad | 12:573f7ce91a0d | 235 | } |
laserdad | 12:573f7ce91a0d | 236 | |
laserdad | 12:573f7ce91a0d | 237 | |
laserdad | 0:2da1f69b38fd | 238 | void OB1203::init_rgb() |
laserdad | 0:2da1f69b38fd | 239 | { |
laserdad | 0:2da1f69b38fd | 240 | /*Configures ALS/RGB mode. PS and BIO off. |
laserdad | 0:2da1f69b38fd | 241 | Use: set class variables using header declarations. Then call this function.*/ |
laserdad | 0:2da1f69b38fd | 242 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 243 | writeBlock(OB1203_ADDR,REG_LS_RES_RATE,writeData,2); |
laserdad | 0:2da1f69b38fd | 244 | writeData[0] = ls_res | ls_rate; //LS_RES_RATE |
laserdad | 0:2da1f69b38fd | 245 | writeData[1] = ls_gain; //LS_GAIN |
laserdad | 0:2da1f69b38fd | 246 | writeBlock(OB1203_ADDR,REG_LS_RES_RATE,writeData,2); |
laserdad | 0:2da1f69b38fd | 247 | setLSthresh(); |
laserdad | 0:2da1f69b38fd | 248 | setIntConfig(); |
laserdad | 0:2da1f69b38fd | 249 | ppg_ps_en = PPG_PS_OFF; |
laserdad | 0:2da1f69b38fd | 250 | ls_en = LS_ON; |
laserdad | 0:2da1f69b38fd | 251 | setMainConfig(); |
laserdad | 0:2da1f69b38fd | 252 | } |
laserdad | 0:2da1f69b38fd | 253 | |
laserdad | 0:2da1f69b38fd | 254 | |
laserdad | 0:2da1f69b38fd | 255 | void OB1203::init_ps() |
laserdad | 0:2da1f69b38fd | 256 | { |
laserdad | 0:2da1f69b38fd | 257 | /*Configures PS mode but not thresholds or interrupts. RGB/ALS and BIO off. |
laserdad | 0:2da1f69b38fd | 258 | Use: set class variables using header declarations. Then call this function.*/ |
laserdad | 0:2da1f69b38fd | 259 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 260 | //PS settings |
laserdad | 0:2da1f69b38fd | 261 | setPScurrent(); |
laserdad | 11:724cf1c68651 | 262 | writeData[0] = ps_can_ana | ps_pulses | 0x02; //PS_CAN_PULSES -->set hidden max current registers to allow higher LED powers |
laserdad | 0:2da1f69b38fd | 263 | writeData[1] = ps_pwidth | ps_rate; //PS_PWIDTH_RATE |
laserdad | 0:2da1f69b38fd | 264 | writeBlock(OB1203_ADDR,REG_PS_CAN_PULSES,writeData,2); |
laserdad | 0:2da1f69b38fd | 265 | //Digital crosstalk cancellation |
laserdad | 0:2da1f69b38fd | 266 | setDigitalCan(); //PS_CAN_DIG |
laserdad | 0:2da1f69b38fd | 267 | //set PS moving average and hysteresis |
laserdad | 0:2da1f69b38fd | 268 | writeData[0] = ps_avg_en | ps_hys_level; //PS_MOV_AVG_HYS |
laserdad | 0:2da1f69b38fd | 269 | writeBlock(OB1203_ADDR,REG_PS_MOV_AVG_HYS,writeData,1); |
laserdad | 0:2da1f69b38fd | 270 | //set PS interrupt thresholds |
laserdad | 0:2da1f69b38fd | 271 | setPSthresh(); |
laserdad | 0:2da1f69b38fd | 272 | //interrupt configuration |
laserdad | 0:2da1f69b38fd | 273 | ls_int_en = LS_INT_OFF; |
laserdad | 0:2da1f69b38fd | 274 | setIntConfig(); |
laserdad | 0:2da1f69b38fd | 275 | setPPG_PSgain_cfg(); |
laserdad | 0:2da1f69b38fd | 276 | setPScurrent(); |
laserdad | 0:2da1f69b38fd | 277 | //config PS |
laserdad | 0:2da1f69b38fd | 278 | ls_en = LS_OFF; |
laserdad | 0:2da1f69b38fd | 279 | ppg_ps_en = 1; |
laserdad | 0:2da1f69b38fd | 280 | ppg_ps_mode = PS_MODE; |
laserdad | 9:0c3d2eea1c79 | 281 | setLEDTrim(); |
laserdad | 0:2da1f69b38fd | 282 | setMainConfig(); |
laserdad | 0:2da1f69b38fd | 283 | } |
laserdad | 0:2da1f69b38fd | 284 | |
laserdad | 0:2da1f69b38fd | 285 | |
laserdad | 0:2da1f69b38fd | 286 | void OB1203::init_ps_rgb() |
laserdad | 0:2da1f69b38fd | 287 | { |
laserdad | 2:3cba0fe6db60 | 288 | reset(); |
laserdad | 0:2da1f69b38fd | 289 | char writeData[2]; |
laserdad | 0:2da1f69b38fd | 290 | writeData[0] = ls_res | ls_rate; //LS_RES_RATE |
laserdad | 0:2da1f69b38fd | 291 | writeData[1] = ls_gain; //LS_GAIN |
laserdad | 0:2da1f69b38fd | 292 | writeBlock(OB1203_ADDR,REG_LS_RES_RATE,writeData,2); |
laserdad | 11:724cf1c68651 | 293 | writeData[0] = ps_can_ana | ps_pulses | 0x02; //PS_CAN_PULSES -->set hidden max current registers to allow higher LED powers |
laserdad | 0:2da1f69b38fd | 294 | writeData[1] = ps_pwidth | ps_rate; //PS_PWIDTH_RATE |
laserdad | 0:2da1f69b38fd | 295 | writeBlock(OB1203_ADDR,REG_PS_CAN_PULSES,writeData,2); |
laserdad | 0:2da1f69b38fd | 296 | setDigitalCan(); //PS_CAN_DIG |
laserdad | 0:2da1f69b38fd | 297 | //set PS moving average and hysteresis |
laserdad | 0:2da1f69b38fd | 298 | writeData[0] = ps_avg_en | ps_hys_level; //PS_MOV_AVG_HYS |
laserdad | 0:2da1f69b38fd | 299 | writeBlock(OB1203_ADDR,REG_PS_MOV_AVG_HYS,writeData,1); |
laserdad | 0:2da1f69b38fd | 300 | setIntConfig(); |
laserdad | 0:2da1f69b38fd | 301 | setPSthresh(); |
laserdad | 16:d5fe5debb5d2 | 302 | setPScurrent(); |
laserdad | 0:2da1f69b38fd | 303 | setLSthresh(); |
laserdad | 0:2da1f69b38fd | 304 | ls_en = LS_ON; |
laserdad | 0:2da1f69b38fd | 305 | ppg_ps_en = PPG_PS_ON; |
laserdad | 0:2da1f69b38fd | 306 | ppg_ps_mode = PS_MODE; |
laserdad | 9:0c3d2eea1c79 | 307 | setLEDTrim(); |
laserdad | 16:d5fe5debb5d2 | 308 | setMainConfig(); |
laserdad | 0:2da1f69b38fd | 309 | } |
laserdad | 0:2da1f69b38fd | 310 | |
laserdad | 0:2da1f69b38fd | 311 | |
laserdad | 0:2da1f69b38fd | 312 | void OB1203::init_hr() |
laserdad | 0:2da1f69b38fd | 313 | { |
laserdad | 2:3cba0fe6db60 | 314 | reset(); |
laserdad | 3:ffcd0d2ec97f | 315 | ps_int_en = PS_INT_OFF; |
laserdad | 9:0c3d2eea1c79 | 316 | ls_en = LS_OFF; |
laserdad | 0:2da1f69b38fd | 317 | setIntConfig(); |
laserdad | 3:ffcd0d2ec97f | 318 | char readData[1]; |
laserdad | 16:d5fe5debb5d2 | 319 | //readBlock(OB1203_ADDR,REG_PS_INT_CFG_1,readData,1); |
laserdad | 8:6c19c052b053 | 320 | // pc.printf("int config 1 = %02X\r\n",readData[0]); |
laserdad | 0:2da1f69b38fd | 321 | setPPG_PSgain_cfg(); |
laserdad | 0:2da1f69b38fd | 322 | setPPGcurrent(); |
laserdad | 0:2da1f69b38fd | 323 | setPPGana_can(); |
laserdad | 0:2da1f69b38fd | 324 | setPPGavg_and_rate(); |
laserdad | 0:2da1f69b38fd | 325 | setFifoConfig(); |
laserdad | 3:ffcd0d2ec97f | 326 | ppg_ps_mode = HR_MODE; |
laserdad | 9:0c3d2eea1c79 | 327 | setBioTrim(); |
laserdad | 9:0c3d2eea1c79 | 328 | setLEDTrim(); |
laserdad | 3:ffcd0d2ec97f | 329 | setMainConfig(); |
laserdad | 0:2da1f69b38fd | 330 | } |
laserdad | 0:2da1f69b38fd | 331 | |
laserdad | 0:2da1f69b38fd | 332 | void OB1203::init_spo2() |
laserdad | 0:2da1f69b38fd | 333 | { |
laserdad | 2:3cba0fe6db60 | 334 | reset(); |
laserdad | 2:3cba0fe6db60 | 335 | ps_int_en = PS_INT_OFF; |
laserdad | 9:0c3d2eea1c79 | 336 | ls_en = LS_OFF; |
laserdad | 0:2da1f69b38fd | 337 | setIntConfig(); |
laserdad | 2:3cba0fe6db60 | 338 | char readData[1]; |
laserdad | 2:3cba0fe6db60 | 339 | readBlock(OB1203_ADDR,REG_PS_INT_CFG_1,readData,1); |
laserdad | 8:6c19c052b053 | 340 | // pc.printf("int config 1 = %02X\r\n",readData[0]); |
laserdad | 0:2da1f69b38fd | 341 | setPPG_PSgain_cfg(); |
laserdad | 0:2da1f69b38fd | 342 | setPPGcurrent(); |
laserdad | 0:2da1f69b38fd | 343 | setPPGana_can(); |
laserdad | 0:2da1f69b38fd | 344 | setPPGavg_and_rate(); |
laserdad | 0:2da1f69b38fd | 345 | setFifoConfig(); |
laserdad | 0:2da1f69b38fd | 346 | ppg_ps_mode = SPO2_MODE; |
laserdad | 9:0c3d2eea1c79 | 347 | setLEDTrim(); |
laserdad | 9:0c3d2eea1c79 | 348 | setBioTrim(); |
laserdad | 0:2da1f69b38fd | 349 | setMainConfig(); |
laserdad | 0:2da1f69b38fd | 350 | } |
laserdad | 0:2da1f69b38fd | 351 | |
laserdad | 0:2da1f69b38fd | 352 | uint32_t OB1203::bytes2uint32(char *data, int start_byte) |
laserdad | 0:2da1f69b38fd | 353 | { |
laserdad | 1:99ca9c464503 | 354 | //coverts a string of 3 bytes with LSB first into unsigned long MSB last |
laserdad | 16:d5fe5debb5d2 | 355 | return ((uint32_t)data[start_byte+2])<<16 | ((uint32_t)data[start_byte+1])<<8 | ((uint32_t)data[start_byte]) ; |
laserdad | 0:2da1f69b38fd | 356 | } |
laserdad | 0:2da1f69b38fd | 357 | |
laserdad | 6:337ee64ca7ab | 358 | uint32_t OB1203::twoandhalfBytes2uint32(char *data, int start_byte) |
laserdad | 6:337ee64ca7ab | 359 | { |
laserdad | 6:337ee64ca7ab | 360 | //coverts a string of 3 bytes with LSB first into unsigned long MSB last |
laserdad | 7:7d90f25c04fa | 361 | return (uint32_t)( ((data[start_byte+2] & 0x0F)<<16) | (uint32_t(data[start_byte+1])<<8) | uint32_t(data[start_byte]) ) ; |
laserdad | 6:337ee64ca7ab | 362 | } |
laserdad | 0:2da1f69b38fd | 363 | |
laserdad | 0:2da1f69b38fd | 364 | char OB1203::get_ls_data(uint32_t *data) |
laserdad | 0:2da1f69b38fd | 365 | { |
laserdad | 5:527556d05aa8 | 366 | char byte_data[21]; |
laserdad | 6:337ee64ca7ab | 367 | readBlock(OB1203_ADDR,REG_STATUS_0,byte_data,21); |
laserdad | 0:2da1f69b38fd | 368 | #ifdef DEBUG |
laserdad | 5:527556d05aa8 | 369 | pc.printf("%02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x $02x\r\n", |
laserdad | 0:2da1f69b38fd | 370 | byte_data[0],byte_data[1],byte_data[2],byte_data[3], |
laserdad | 0:2da1f69b38fd | 371 | byte_data[4],byte_data[5],byte_data[6],byte_data[7], |
laserdad | 0:2da1f69b38fd | 372 | byte_data[8],byte_data[9],byte_data[10],byte_data[11], |
laserdad | 0:2da1f69b38fd | 373 | byte_data[12],byte_data[13],byte_data[14],byte_data[15], |
laserdad | 5:527556d05aa8 | 374 | byte_data[16],byte_data[17],byte_data[18]), |
laserdad | 5:527556d05aa8 | 375 | byte_data[19],byte_data[20]; |
laserdad | 0:2da1f69b38fd | 376 | #endif |
laserdad | 0:2da1f69b38fd | 377 | |
laserdad | 1:99ca9c464503 | 378 | |
laserdad | 1:99ca9c464503 | 379 | //byte_data[0] is ps (not populated) |
laserdad | 6:337ee64ca7ab | 380 | data[1] = twoandhalfBytes2uint32(byte_data,4); //w |
laserdad | 6:337ee64ca7ab | 381 | data[2] = twoandhalfBytes2uint32(byte_data,7); //g |
laserdad | 6:337ee64ca7ab | 382 | data[3] = twoandhalfBytes2uint32(byte_data,10); //b |
laserdad | 6:337ee64ca7ab | 383 | data[4] = twoandhalfBytes2uint32(byte_data,13); //r |
laserdad | 6:337ee64ca7ab | 384 | data[5] = twoandhalfBytes2uint32(byte_data,16); //c |
laserdad | 6:337ee64ca7ab | 385 | data[6] = (uint32_t)((byte_data[20] & 0x0F)<<8) | (uint32_t)byte_data[19] ; //temp data |
laserdad | 0:2da1f69b38fd | 386 | return ( (byte_data[0] & LS_NEW_DATA) == 0x01 ? 1 : 0); //return 1 if new data or 0 if old data |
laserdad | 0:2da1f69b38fd | 387 | } |
laserdad | 0:2da1f69b38fd | 388 | |
laserdad | 0:2da1f69b38fd | 389 | char OB1203::get_ps_data(uint32_t *data) |
laserdad | 0:2da1f69b38fd | 390 | { |
laserdad | 0:2da1f69b38fd | 391 | char byte_data[4]; |
laserdad | 6:337ee64ca7ab | 392 | readBlock(OB1203_ADDR,REG_STATUS_0,byte_data,4); |
laserdad | 0:2da1f69b38fd | 393 | #ifdef DEBUG |
laserdad | 0:2da1f69b38fd | 394 | pc.printf( "%02x %02x %02x %02x\r\n", byte_data[0], byte_data[1], byte_data[2], byte_data[3] ); |
laserdad | 0:2da1f69b38fd | 395 | #endif |
laserdad | 1:99ca9c464503 | 396 | |
laserdad | 1:99ca9c464503 | 397 | data[0] = ((uint32_t)byte_data[3])<<8 | ((uint32_t)byte_data[2]); //ps data |
laserdad | 0:2da1f69b38fd | 398 | return ( (byte_data[1] & PS_NEW_DATA) == 0x01 ? 1 : 0); //return 1 if new data or 0 if old data |
laserdad | 0:2da1f69b38fd | 399 | } |
laserdad | 0:2da1f69b38fd | 400 | |
laserdad | 0:2da1f69b38fd | 401 | char OB1203::get_ps_ls_data(uint32_t *data) |
laserdad | 0:2da1f69b38fd | 402 | { |
laserdad | 4:f25ca600a0e6 | 403 | char byte_data[21]; |
laserdad | 4:f25ca600a0e6 | 404 | readBlock(OB1203_ADDR,REG_STATUS_0,byte_data,21); |
laserdad | 0:2da1f69b38fd | 405 | #ifdef DEBUG |
laserdad | 4:f25ca600a0e6 | 406 | pc.printf("%02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x $02x\r\n", |
laserdad | 0:2da1f69b38fd | 407 | byte_data[0],byte_data[1],byte_data[2],byte_data[3],byte_data[4], |
laserdad | 0:2da1f69b38fd | 408 | byte_data[5],byte_data[6],byte_data[7],byte_data[8],byte_data[9], |
laserdad | 0:2da1f69b38fd | 409 | byte_data[10],byte_data[11],byte_data[12],byte_data[13],byte_data[14], |
laserdad | 4:f25ca600a0e6 | 410 | byte_data[15],byte_data[16],byte_data[17],byte_data[18] ), |
laserdad | 4:f25ca600a0e6 | 411 | byte_data[19],byte_data[20]; |
laserdad | 0:2da1f69b38fd | 412 | #endif |
laserdad | 0:2da1f69b38fd | 413 | |
laserdad | 1:99ca9c464503 | 414 | data[0] = ((uint32_t)byte_data[3])<<8 | ((uint32_t)byte_data[2]); //ps |
laserdad | 6:337ee64ca7ab | 415 | data[1] = twoandhalfBytes2uint32(byte_data,4); //w |
laserdad | 6:337ee64ca7ab | 416 | data[2] = twoandhalfBytes2uint32(byte_data,7); //g |
laserdad | 6:337ee64ca7ab | 417 | data[3] = twoandhalfBytes2uint32(byte_data,10); //b |
laserdad | 6:337ee64ca7ab | 418 | data[4] = twoandhalfBytes2uint32(byte_data,13); //r |
laserdad | 6:337ee64ca7ab | 419 | data[5] = twoandhalfBytes2uint32(byte_data,16); //c |
laserdad | 6:337ee64ca7ab | 420 | data[6] = (uint32_t)((byte_data[20] & 0x0F)<<8) | (uint32_t)byte_data[19] ; //temp data |
laserdad | 0:2da1f69b38fd | 421 | return ( (byte_data[0] & LS_NEW_DATA) == 0x01 ? 1 : 0); //return 1 if new data or 0 if old data |
laserdad | 0:2da1f69b38fd | 422 | } |
laserdad | 0:2da1f69b38fd | 423 | |
laserdad | 0:2da1f69b38fd | 424 | |
laserdad | 0:2da1f69b38fd | 425 | void OB1203::getFifoInfo(char *fifo_info) |
laserdad | 0:2da1f69b38fd | 426 | { |
laserdad | 0:2da1f69b38fd | 427 | readBlock(OB1203_ADDR,REG_FIFO_WR_PTR,fifo_info,3); |
laserdad | 0:2da1f69b38fd | 428 | writePointer = fifo_info[0]; |
laserdad | 0:2da1f69b38fd | 429 | readPointer = fifo_info[1]; |
laserdad | 0:2da1f69b38fd | 430 | fifoOverflow = fifo_info[2]; |
laserdad | 0:2da1f69b38fd | 431 | } |
laserdad | 0:2da1f69b38fd | 432 | |
laserdad | 0:2da1f69b38fd | 433 | |
laserdad | 0:2da1f69b38fd | 434 | uint8_t OB1203::getNumFifoSamplesAvailable() |
laserdad | 0:2da1f69b38fd | 435 | { |
laserdad | 0:2da1f69b38fd | 436 | uint8_t numSamples = writePointer; |
laserdad | 0:2da1f69b38fd | 437 | if (writePointer<readPointer) |
laserdad | 0:2da1f69b38fd | 438 | { |
laserdad | 0:2da1f69b38fd | 439 | numSamples += 31-readPointer; |
laserdad | 0:2da1f69b38fd | 440 | } |
laserdad | 0:2da1f69b38fd | 441 | return numSamples; |
laserdad | 0:2da1f69b38fd | 442 | } |
laserdad | 0:2da1f69b38fd | 443 | |
laserdad | 0:2da1f69b38fd | 444 | |
laserdad | 0:2da1f69b38fd | 445 | void OB1203::getFifoSamples(uint8_t numSamples, char *fifoData) |
laserdad | 0:2da1f69b38fd | 446 | { |
laserdad | 2:3cba0fe6db60 | 447 | readBlock(OB1203_ADDR,REG_FIFO_DATA,fifoData,3*numSamples); |
laserdad | 0:2da1f69b38fd | 448 | } |
laserdad | 0:2da1f69b38fd | 449 | |
laserdad | 0:2da1f69b38fd | 450 | |
laserdad | 0:2da1f69b38fd | 451 | void OB1203::parseFifoSamples(char numSamples, char *fifoData, uint32_t *assembledData) |
laserdad | 0:2da1f69b38fd | 452 | { |
laserdad | 0:2da1f69b38fd | 453 | for (int n=0; n<numSamples; n++) |
laserdad | 0:2da1f69b38fd | 454 | { |
laserdad | 0:2da1f69b38fd | 455 | assembledData[n] = bytes2uint32(fifoData,3*n); |
laserdad | 0:2da1f69b38fd | 456 | } |
laserdad | 0:2da1f69b38fd | 457 | } |
laserdad | 0:2da1f69b38fd | 458 | |
laserdad | 0:2da1f69b38fd | 459 | |
laserdad | 0:2da1f69b38fd | 460 | char OB1203::get_part_ID(char *data) |
laserdad | 0:2da1f69b38fd | 461 | { |
laserdad | 0:2da1f69b38fd | 462 | readBlock(OB1203_ADDR,REG_PART_ID,data,1); |
laserdad | 0:2da1f69b38fd | 463 | return data[0]; |
laserdad | 19:a27b98998edf | 464 | } |
laserdad | 19:a27b98998edf | 465 | |
laserdad | 19:a27b98998edf | 466 | |
laserdad | 19:a27b98998edf | 467 | void OB1203::do_agc(uint32_t data, bool ch) |
laserdad | 19:a27b98998edf | 468 | { |
laserdad | 19:a27b98998edf | 469 | const uint32_t tol1 = TOL1; |
laserdad | 19:a27b98998edf | 470 | const uint32_t tol2 = TOL2; |
laserdad | 19:a27b98998edf | 471 | const uint16_t in_range_persist = IN_RANGE_PERSIST; |
laserdad | 19:a27b98998edf | 472 | static uint16_t in_range[2] = {0,0}; |
laserdad | 19:a27b98998edf | 473 | const uint16_t maxCurrent[2] = {IR_MAX_CURRENT , R_MAX_CURRENT}; |
laserdad | 19:a27b98998edf | 474 | const uint16_t step = STEP; |
laserdad | 19:a27b98998edf | 475 | const uint32_t targetCounts[2] = {IR_TARGET_COUNTS, R_TARGET_COUNTS}; |
laserdad | 19:a27b98998edf | 476 | //ch = 0 for IR, 1 for R (channel) |
laserdad | 19:a27b98998edf | 477 | if( data > targetCounts[ch] + (in_range[ch]>in_range_persist ? tol2: tol1) ) |
laserdad | 19:a27b98998edf | 478 | { |
laserdad | 19:a27b98998edf | 479 | if(data>targetCounts[ch] + tol2) |
laserdad | 19:a27b98998edf | 480 | in_range[ch]=0; |
laserdad | 19:a27b98998edf | 481 | |
laserdad | 19:a27b98998edf | 482 | |
laserdad | 19:a27b98998edf | 483 | if( (ch ? r_current : ir_current)>step) |
laserdad | 19:a27b98998edf | 484 | { |
laserdad | 19:a27b98998edf | 485 | (ch ? r_current : ir_current) -= step; |
laserdad | 19:a27b98998edf | 486 | update = 1; |
laserdad | 19:a27b98998edf | 487 | } |
laserdad | 19:a27b98998edf | 488 | } |
laserdad | 19:a27b98998edf | 489 | else if( data < targetCounts[ch] - (in_range[ch]>in_range_persist ? tol2 : tol1) ) |
laserdad | 19:a27b98998edf | 490 | { |
laserdad | 19:a27b98998edf | 491 | if(data<targetCounts[ch] - tol2) |
laserdad | 19:a27b98998edf | 492 | in_range[ch]=0; |
laserdad | 19:a27b98998edf | 493 | if( (ch ? r_current : ir_current) +step<maxCurrent[ch]) //no need to go to full current |
laserdad | 19:a27b98998edf | 494 | { |
laserdad | 19:a27b98998edf | 495 | (ch ? r_current : ir_current) += step; |
laserdad | 19:a27b98998edf | 496 | update = 1; |
laserdad | 19:a27b98998edf | 497 | } |
laserdad | 19:a27b98998edf | 498 | } |
laserdad | 19:a27b98998edf | 499 | else |
laserdad | 19:a27b98998edf | 500 | { |
laserdad | 19:a27b98998edf | 501 | if( (data > (targetCounts[ch]-tol1) ) && (data < (targetCounts[ch]+tol1)) ) |
laserdad | 19:a27b98998edf | 502 | in_range[ch]++; |
laserdad | 19:a27b98998edf | 503 | } |
laserdad | 0:2da1f69b38fd | 504 | } |