![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Mode1 Optical Validation
main.cpp@26:33c0d3fd2a95, 2021-06-23 (annotated)
- Committer:
- phonemacro
- Date:
- Wed Jun 23 21:36:13 2021 +0000
- Revision:
- 26:33c0d3fd2a95
- Parent:
- 25:e790416e273e
- Child:
- 27:a45d6e38f2de
correct MFIO setting
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
phonemacro | 0:6f65cae31c54 | 1 | /******************************************************************************* |
phonemacro | 9:12720bbacfe2 | 2 | * Copyright (C) 2021 Maxim Integrated Products, Inc., All Rights Reserved. |
phonemacro | 0:6f65cae31c54 | 3 | * |
phonemacro | 0:6f65cae31c54 | 4 | * Permission is hereby granted, free of charge, to any person obtaining a |
phonemacro | 0:6f65cae31c54 | 5 | * copy of this software and associated documentation files (the "Software"), |
phonemacro | 0:6f65cae31c54 | 6 | * to deal in the Software without restriction, including without limitation |
phonemacro | 0:6f65cae31c54 | 7 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
phonemacro | 0:6f65cae31c54 | 8 | * and/or sell copies of the Software, and to permit persons to whom the |
phonemacro | 0:6f65cae31c54 | 9 | * Software is furnished to do so, subject to the following conditions: |
phonemacro | 0:6f65cae31c54 | 10 | * |
phonemacro | 0:6f65cae31c54 | 11 | * The above copyright notice and this permission notice shall be included |
phonemacro | 0:6f65cae31c54 | 12 | * in all copies or substantial portions of the Software. |
phonemacro | 0:6f65cae31c54 | 13 | * |
phonemacro | 0:6f65cae31c54 | 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
phonemacro | 0:6f65cae31c54 | 15 | * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
phonemacro | 0:6f65cae31c54 | 16 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
phonemacro | 0:6f65cae31c54 | 17 | * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES |
phonemacro | 0:6f65cae31c54 | 18 | * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
phonemacro | 0:6f65cae31c54 | 19 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
phonemacro | 0:6f65cae31c54 | 20 | * OTHER DEALINGS IN THE SOFTWARE. |
phonemacro | 0:6f65cae31c54 | 21 | * |
phonemacro | 0:6f65cae31c54 | 22 | * Except as contained in this notice, the name of Maxim Integrated |
phonemacro | 0:6f65cae31c54 | 23 | * Products, Inc. shall not be used except as stated in the Maxim Integrated |
phonemacro | 0:6f65cae31c54 | 24 | * Products, Inc. Branding Policy. |
phonemacro | 0:6f65cae31c54 | 25 | * |
phonemacro | 0:6f65cae31c54 | 26 | * The mere transfer of this software does not imply any licenses |
phonemacro | 0:6f65cae31c54 | 27 | * of trade secrets, proprietary technology, copyrights, patents, |
phonemacro | 0:6f65cae31c54 | 28 | * trademarks, maskwork rights, or any other form of intellectual |
phonemacro | 0:6f65cae31c54 | 29 | * property whatsoever. Maxim Integrated Products, Inc. retains all |
phonemacro | 0:6f65cae31c54 | 30 | * ownership rights. |
phonemacro | 0:6f65cae31c54 | 31 | ******************************************************************************* |
phonemacro | 0:6f65cae31c54 | 32 | */ |
phonemacro | 0:6f65cae31c54 | 33 | |
phonemacro | 0:6f65cae31c54 | 34 | #include "mbed.h" |
phonemacro | 0:6f65cae31c54 | 35 | #include "platform/mbed_thread.h" |
phonemacro | 3:da975696b936 | 36 | #include "mbed.h" |
phonemacro | 4:4f1e9439f048 | 37 | /****************************************************************************** |
phonemacro | 16:ff1122f0624a | 38 | * https://os.mbed.com/users/phonemacro/code/MAX32664C_Example_Host_Code |
phonemacro | 16:ff1122f0624a | 39 | * Tera Term output is set to 115200 baud rate. |
phonemacro | 24:064478ff33d2 | 40 | * ver: 210622 |
phonemacro | 16:ff1122f0624a | 41 | ******************************************************************************/ |
phonemacro | 16:ff1122f0624a | 42 | |
phonemacro | 16:ff1122f0624a | 43 | /****************************************************************************** |
phonemacro | 4:4f1e9439f048 | 44 | * Warning, if using the either |
phonemacro | 4:4f1e9439f048 | 45 | * MAX32630FTHR+MAXM86161_ADPTER_REVB+MAXM86146EVSYS sensor brd or |
phonemacro | 4:4f1e9439f048 | 46 | * MAX32630FTHR+MAXM86161_ADPTER_REVB+MAXM86161EVSYS sensor brd, |
phonemacro | 4:4f1e9439f048 | 47 | * The VLED is connected to USB power which is noisy. The VLED should be |
phonemacro | 4:4f1e9439f048 | 48 | * connected to a regulated power supply if you are testing accuracy. |
phonemacro | 4:4f1e9439f048 | 49 | ******************************************************************************* |
phonemacro | 4:4f1e9439f048 | 50 | */ |
phonemacro | 5:7f5a012747a5 | 51 | |
phonemacro | 24:064478ff33d2 | 52 | /*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*/ |
phonemacro | 6:e1b7190d6cb5 | 53 | // define one and only one of the following three platforms |
phonemacro | 21:67d58af1ec56 | 54 | #define MAXM86146_CFG 1 // tested on MAXM86146EVSYS_sensorBrd+MAXM86161_ADAPTER_REVB+MAX32630FTHR 33.13.12 |
phonemacro | 21:67d58af1ec56 | 55 | //#define MAXREFDES103_CFG // not tested |
phonemacro | 21:67d58af1ec56 | 56 | //#define MAXM86161_CFG 1 // tested on MAXM86161+MAX32630FTHR v32.9.22, 32.13.12 |
phonemacro | 6:e1b7190d6cb5 | 57 | /*****************************************************************************/ |
phonemacro | 24:064478ff33d2 | 58 | |
phonemacro | 24:064478ff33d2 | 59 | /*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*/ |
phonemacro | 24:064478ff33d2 | 60 | // define which adaptor board is being used |
phonemacro | 26:33c0d3fd2a95 | 61 | #define MAXM86161_ADPTR_EVKIT_B |
phonemacro | 26:33c0d3fd2a95 | 62 | //#define MAXREFDES1319 // MAXM86161: Remove J7; For PIN1=ACC_INTN, J9 set to 2-3; For PIN13=OPT_INTN, J10 set to 2-3 |
phonemacro | 24:064478ff33d2 | 63 | /****************************************************************************** |
phonemacro | 24:064478ff33d2 | 64 | * MAX32630FTHR GPIOs |
phonemacro | 24:064478ff33d2 | 65 | ******************************************************************************/ |
phonemacro | 24:064478ff33d2 | 66 | #ifdef MAXM86161_ADPTR_EVKIT_B |
phonemacro | 24:064478ff33d2 | 67 | #define RST_PIN P5_6 |
phonemacro | 24:064478ff33d2 | 68 | #define MFIO_PIN P5_4 |
phonemacro | 24:064478ff33d2 | 69 | #else |
phonemacro | 24:064478ff33d2 | 70 | #ifdef MAXREFDES1319 |
phonemacro | 24:064478ff33d2 | 71 | #define RST_PIN P3_0 |
phonemacro | 24:064478ff33d2 | 72 | #define MFIO_PIN P5_2 |
phonemacro | 24:064478ff33d2 | 73 | #endif |
phonemacro | 24:064478ff33d2 | 74 | #endif |
phonemacro | 24:064478ff33d2 | 75 | |
phonemacro | 24:064478ff33d2 | 76 | DigitalOut rst(RST_PIN, PullUp); |
phonemacro | 24:064478ff33d2 | 77 | DigitalOut mfio(MFIO_PIN, PullUp); |
phonemacro | 24:064478ff33d2 | 78 | I2C sh_i2c(P3_4, P3_5); |
phonemacro | 24:064478ff33d2 | 79 | |
phonemacro | 24:064478ff33d2 | 80 | /*****************************************************************************/ |
phonemacro | 26:33c0d3fd2a95 | 81 | #if defined(MAXM86161_CFG) //|| defined(MAXM86146_CFG) // don't need 3.3V for MAXM86146EVSYS_sensorBrd+MAXM86161_ADAPTER_REVB+MAX32630FTHR |
phonemacro | 17:0d6e99a0fd8d | 82 | #include "max32630fthr.h" |
phonemacro | 17:0d6e99a0fd8d | 83 | MAX32630FTHR pegasus(MAX32630FTHR::VIO_3V3); // Enable J1-pin2, 3.3V and set GPIO to 3.3v |
phonemacro | 21:67d58af1ec56 | 84 | #endif |
phonemacro | 26:33c0d3fd2a95 | 85 | |
phonemacro | 26:33c0d3fd2a95 | 86 | /*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*/ |
phonemacro | 14:c8cc6d7fd5f9 | 87 | //#define RAW // define this if you only AFE+accel data, no algo |
phonemacro | 14:c8cc6d7fd5f9 | 88 | #define ALGO_ONLY 1 // define this if you only want algo data, comment out if you want raw sensor+algo data |
phonemacro | 12:17a0bf823462 | 89 | //#define EXTENDED_ALGO 1 // define this if you want the extended algo format |
phonemacro | 13:1baccc6275a7 | 90 | //#define AGC 1 // define this for AGC, otherwise the default is AEC |
phonemacro | 6:e1b7190d6cb5 | 91 | |
phonemacro | 6:e1b7190d6cb5 | 92 | #ifdef MAXREFDES103_CFG |
phonemacro | 5:7f5a012747a5 | 93 | #include "MAX20303.h" |
phonemacro | 6:e1b7190d6cb5 | 94 | I2C sh_i2c_pmic(P5_7, P6_0); |
phonemacro | 5:7f5a012747a5 | 95 | #endif |
phonemacro | 5:7f5a012747a5 | 96 | |
phonemacro | 2:563d90a111b3 | 97 | #ifdef MAXM86146_CFG |
phonemacro | 0:6f65cae31c54 | 98 | #define PPG_SZ 36 //maxm86146 |
phonemacro | 0:6f65cae31c54 | 99 | #else |
phonemacro | 0:6f65cae31c54 | 100 | #define PPG_SZ 18 //maxm86161, max86141 |
phonemacro | 0:6f65cae31c54 | 101 | #endif |
phonemacro | 0:6f65cae31c54 | 102 | #define ACCEL_SZ 6 // accel |
phonemacro | 0:6f65cae31c54 | 103 | #define SENSOR_SZ (PPG_SZ+ACCEL_SZ) |
phonemacro | 18:f4c95b1c0efc | 104 | |
phonemacro | 21:67d58af1ec56 | 105 | //#define old_msbl 1 // 3x.12.0 or earlier |
phonemacro | 18:f4c95b1c0efc | 106 | #ifdef old_msbl |
phonemacro | 18:f4c95b1c0efc | 107 | #ifdef EXTENDED_ALGO |
phonemacro | 18:f4c95b1c0efc | 108 | #define ALGO_SZ 52 // 52 bytes is the extended algo size for 3x.12.0 |
phonemacro | 18:f4c95b1c0efc | 109 | #else |
phonemacro | 18:f4c95b1c0efc | 110 | #define ALGO_SZ 20 // 20 bytes is the algo normal size for 3x.12.0 |
phonemacro | 18:f4c95b1c0efc | 111 | #endif |
phonemacro | 12:17a0bf823462 | 112 | #else |
phonemacro | 18:f4c95b1c0efc | 113 | #ifdef EXTENDED_ALGO |
phonemacro | 21:67d58af1ec56 | 114 | #define ALGO_SZ 56 // 56 bytes is the extended algo size for 3x.13.x+ |
phonemacro | 18:f4c95b1c0efc | 115 | #else |
phonemacro | 21:67d58af1ec56 | 116 | #define ALGO_SZ 24 // 24 bytes is the algo normal size for 3x.13.x+ |
phonemacro | 18:f4c95b1c0efc | 117 | #endif |
phonemacro | 12:17a0bf823462 | 118 | #endif |
phonemacro | 18:f4c95b1c0efc | 119 | |
phonemacro | 0:6f65cae31c54 | 120 | #ifdef ALGO_ONLY |
phonemacro | 0:6f65cae31c54 | 121 | #define TTL_SZ (ALGO_SZ) |
phonemacro | 0:6f65cae31c54 | 122 | #else |
phonemacro | 14:c8cc6d7fd5f9 | 123 | #ifdef RAW |
phonemacro | 14:c8cc6d7fd5f9 | 124 | #define TTL_SZ (PPG_SZ+ACCEL_SZ) |
phonemacro | 14:c8cc6d7fd5f9 | 125 | #else |
phonemacro | 14:c8cc6d7fd5f9 | 126 | #define TTL_SZ (PPG_SZ+ACCEL_SZ+ALGO_SZ) |
phonemacro | 14:c8cc6d7fd5f9 | 127 | #endif |
phonemacro | 0:6f65cae31c54 | 128 | #endif |
phonemacro | 0:6f65cae31c54 | 129 | |
phonemacro | 3:da975696b936 | 130 | Serial pc(USBTX, USBRX, 115200); |
phonemacro | 0:6f65cae31c54 | 131 | DigitalOut rLED(LED1); |
phonemacro | 0:6f65cae31c54 | 132 | DigitalOut gLED(LED2); |
phonemacro | 0:6f65cae31c54 | 133 | DigitalOut bLED(LED3); |
phonemacro | 6:e1b7190d6cb5 | 134 | |
phonemacro | 6:e1b7190d6cb5 | 135 | //#define thread_sleep_for(x) wait_ms(x) // for older versions of mbed |
phonemacro | 0:6f65cae31c54 | 136 | |
phonemacro | 5:7f5a012747a5 | 137 | |
phonemacro | 6:e1b7190d6cb5 | 138 | const int SH_ADDR = 0xAA;//0x55; |
phonemacro | 0:6f65cae31c54 | 139 | int32_t Time_to_Read_PPG = 0; |
phonemacro | 0:6f65cae31c54 | 140 | |
phonemacro | 0:6f65cae31c54 | 141 | #define BLINKING_RATE_MS 1000ms |
phonemacro | 0:6f65cae31c54 | 142 | void blink_timer(void) { |
phonemacro | 0:6f65cae31c54 | 143 | gLED = !gLED; /* blink the green LED */ |
phonemacro | 0:6f65cae31c54 | 144 | } |
phonemacro | 0:6f65cae31c54 | 145 | |
phonemacro | 0:6f65cae31c54 | 146 | void fifo_timer(void) { |
phonemacro | 0:6f65cae31c54 | 147 | Time_to_Read_PPG = 1; |
phonemacro | 0:6f65cae31c54 | 148 | } |
phonemacro | 0:6f65cae31c54 | 149 | |
phonemacro | 14:c8cc6d7fd5f9 | 150 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 151 | // read_sh_fifo |
phonemacro | 14:c8cc6d7fd5f9 | 152 | /*****************************************************************************/ |
phonemacro | 10:192ea88e964b | 153 | void read_sh_fifo(void) { |
phonemacro | 0:6f65cae31c54 | 154 | char cmd[8], i, j, samples; |
phonemacro | 0:6f65cae31c54 | 155 | char rsp[3000]; |
phonemacro | 0:6f65cae31c54 | 156 | int32_t ppg[12]; |
phonemacro | 5:7f5a012747a5 | 157 | int16_t accel[3]; |
phonemacro | 12:17a0bf823462 | 158 | int32_t status, opmode, hr, hr_conf, ibi, ibi_conf; |
phonemacro | 12:17a0bf823462 | 159 | #ifdef EXTENDED_ALGO |
phonemacro | 12:17a0bf823462 | 160 | int32_t walk_stp, run_stp, energy, amr, iadj1_rqt, iadj1, iadj2_rqt, iadj2, iadj3_rqt, iadj3; |
phonemacro | 12:17a0bf823462 | 161 | int32_t intadj_rqt, intadj, smpladj_rqt, smpladj, rqt_smplave, afestatehr, hr_motion; |
phonemacro | 12:17a0bf823462 | 162 | #endif |
phonemacro | 12:17a0bf823462 | 163 | int32_t act, r, spo2, spo2_conf; |
phonemacro | 4:4f1e9439f048 | 164 | int32_t spo2_compl, spo2_lo, spo2_mo, spo2_lopi, spo2_unrel, spo2_state, ibi_offset, scd; |
phonemacro | 2:563d90a111b3 | 165 | int32_t scnt = 0; |
phonemacro | 0:6f65cae31c54 | 166 | int32_t ptr = 0; |
phonemacro | 0:6f65cae31c54 | 167 | int32_t sptr = 0; |
phonemacro | 1:da792e46a385 | 168 | mfio = 0; wait_us(300); |
phonemacro | 0:6f65cae31c54 | 169 | Time_to_Read_PPG = 0; |
phonemacro | 22:f6b366c3b954 | 170 | #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG) |
phonemacro | 0:6f65cae31c54 | 171 | // 2.1 |
phonemacro | 4:4f1e9439f048 | 172 | cmd[0] = 0x00; cmd[1] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 173 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 22:f6b366c3b954 | 174 | wait_us(100); |
phonemacro | 6:e1b7190d6cb5 | 175 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 3:da975696b936 | 176 | // pc.printf("2.1 Status: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 22:f6b366c3b954 | 177 | #else |
phonemacro | 22:f6b366c3b954 | 178 | // testd 33.13.12 doesn't need 2.1 |
phonemacro | 0:6f65cae31c54 | 179 | #endif |
phonemacro | 0:6f65cae31c54 | 180 | // 2.2 |
phonemacro | 4:4f1e9439f048 | 181 | cmd[0] = 0x12; cmd[1] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 182 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 22:f6b366c3b954 | 183 | wait_us(100); |
phonemacro | 6:e1b7190d6cb5 | 184 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 3:da975696b936 | 185 | // pc.printf("2.2 Status: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 0:6f65cae31c54 | 186 | samples = rsp[1]; |
phonemacro | 3:da975696b936 | 187 | // pc.printf("num samples %d, (num*ttl)+1 %d\n\r", rsp[1], TTL_SZ*samples+1); |
phonemacro | 3:da975696b936 | 188 | // pc.printf("num smpls %d \n\r", samples); |
phonemacro | 0:6f65cae31c54 | 189 | scnt = rsp[1]; |
phonemacro | 0:6f65cae31c54 | 190 | // 2.3 |
phonemacro | 4:4f1e9439f048 | 191 | cmd[0] = 0x12; cmd[1] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 192 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 22:f6b366c3b954 | 193 | wait_us(100); |
phonemacro | 6:e1b7190d6cb5 | 194 | sh_i2c.read(SH_ADDR, rsp, 1+(TTL_SZ*samples)); |
phonemacro | 22:f6b366c3b954 | 195 | mfio = 1; |
phonemacro | 21:67d58af1ec56 | 196 | |
phonemacro | 0:6f65cae31c54 | 197 | status = rsp[0]; |
phonemacro | 5:7f5a012747a5 | 198 | |
phonemacro | 0:6f65cae31c54 | 199 | sptr = 1; |
phonemacro | 0:6f65cae31c54 | 200 | for (i = 0; i < scnt; i++) { |
phonemacro | 0:6f65cae31c54 | 201 | #ifdef ALGO_ONLY |
phonemacro | 0:6f65cae31c54 | 202 | ptr = sptr; |
phonemacro | 0:6f65cae31c54 | 203 | #else |
phonemacro | 2:563d90a111b3 | 204 | ptr = sptr; |
phonemacro | 2:563d90a111b3 | 205 | ppg[0] = (rsp[ptr+0] << 16) | (rsp[ptr+1] << 8) | (rsp[ptr+2]); |
phonemacro | 2:563d90a111b3 | 206 | ppg[1] = (rsp[ptr+3] << 16) | (rsp[ptr+4] << 8) | (rsp[ptr+5]); |
phonemacro | 2:563d90a111b3 | 207 | ppg[2] = (rsp[ptr+6] << 16) | (rsp[ptr+7] << 8) | (rsp[ptr+8]); |
phonemacro | 3:da975696b936 | 208 | ppg[3] = (rsp[ptr+9] << 16) | (rsp[ptr+10] << 8) | (rsp[ptr+11]); |
phonemacro | 4:4f1e9439f048 | 209 | ppg[4] = (rsp[ptr+12] << 16) | (rsp[ptr+13] << 8) | (rsp[ptr+14]); |
phonemacro | 4:4f1e9439f048 | 210 | ppg[5] = (rsp[ptr+15] << 16) | (rsp[ptr+16] << 8) | (rsp[ptr+17]); |
phonemacro | 3:da975696b936 | 211 | pc.printf("%d,%d,%d,%d,", ppg[0], ppg[1], ppg[2], ppg[3]); |
phonemacro | 14:c8cc6d7fd5f9 | 212 | #ifdef MAXM86146_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 213 | #ifdef RAW |
phonemacro | 14:c8cc6d7fd5f9 | 214 | pc.printf("%d,%d,", ppg[4], ppg[5]); |
phonemacro | 14:c8cc6d7fd5f9 | 215 | ppg[6] = (rsp[ptr+18] << 16) | (rsp[ptr+19] << 8) | (rsp[ptr+20]); |
phonemacro | 14:c8cc6d7fd5f9 | 216 | ppg[7] = (rsp[ptr+21] << 16) | (rsp[ptr+22] << 8) | (rsp[ptr+23]); |
phonemacro | 14:c8cc6d7fd5f9 | 217 | ppg[8] = (rsp[ptr+24] << 16) | (rsp[ptr+25] << 8) | (rsp[ptr+26]); |
phonemacro | 14:c8cc6d7fd5f9 | 218 | ppg[9] = (rsp[ptr+27] << 16) | (rsp[ptr+28] << 8) | (rsp[ptr+29]); |
phonemacro | 14:c8cc6d7fd5f9 | 219 | ppg[10] = (rsp[ptr+30] << 16) | (rsp[ptr+31] << 8) | (rsp[ptr+32]); |
phonemacro | 14:c8cc6d7fd5f9 | 220 | ppg[11] = (rsp[ptr+33] << 16) | (rsp[ptr+34] << 8) | (rsp[ptr+35]); |
phonemacro | 14:c8cc6d7fd5f9 | 221 | pc.printf("%d,%d,%d,%d,%d,%d,", ppg[6], ppg[7],ppg[8], ppg[9],ppg[10], ppg[11]); |
phonemacro | 14:c8cc6d7fd5f9 | 222 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 223 | #endif |
phonemacro | 5:7f5a012747a5 | 224 | accel[0] = (rsp[PPG_SZ+0] << 8) | (rsp[PPG_SZ+1]); |
phonemacro | 5:7f5a012747a5 | 225 | accel[1] = (rsp[PPG_SZ+2] << 8) | (rsp[PPG_SZ+3]); |
phonemacro | 5:7f5a012747a5 | 226 | accel[2] = (rsp[PPG_SZ+4] << 8) | (rsp[PPG_SZ+5]); |
phonemacro | 5:7f5a012747a5 | 227 | pc.printf("%d,%d,%d,", accel[0], accel[1], accel[2]); |
phonemacro | 5:7f5a012747a5 | 228 | |
phonemacro | 0:6f65cae31c54 | 229 | ptr = sptr + SENSOR_SZ; |
phonemacro | 0:6f65cae31c54 | 230 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 231 | #ifndef RAW |
phonemacro | 12:17a0bf823462 | 232 | #ifdef EXTENDED_ALGO |
phonemacro | 3:da975696b936 | 233 | // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ); |
phonemacro | 0:6f65cae31c54 | 234 | opmode = rsp[ptr]; |
phonemacro | 0:6f65cae31c54 | 235 | hr = (rsp[ptr+1] << 8) + rsp[ptr+2]; |
phonemacro | 0:6f65cae31c54 | 236 | hr_conf = rsp[ptr+3]; |
phonemacro | 12:17a0bf823462 | 237 | ibi = (rsp[ptr+4] << 8) + rsp[ptr+5]; |
phonemacro | 12:17a0bf823462 | 238 | |
phonemacro | 12:17a0bf823462 | 239 | ibi_conf = rsp[ptr+6]; |
phonemacro | 12:17a0bf823462 | 240 | act = rsp[ptr+7]; |
phonemacro | 12:17a0bf823462 | 241 | walk_stp = (rsp[ptr+8] << 24) + (rsp[ptr+9] << 16) + (rsp[ptr+10] << 8) + rsp[ptr+11]; |
phonemacro | 12:17a0bf823462 | 242 | run_stp = (rsp[ptr+12] << 24) + (rsp[ptr+13] << 16) + (rsp[ptr+14] << 8) + rsp[ptr+15]; |
phonemacro | 12:17a0bf823462 | 243 | |
phonemacro | 12:17a0bf823462 | 244 | energy = (rsp[ptr+16] << 24) + (rsp[ptr+17] << 16) + (rsp[ptr+18] << 8) + rsp[ptr+19]; |
phonemacro | 12:17a0bf823462 | 245 | amr = (rsp[ptr+20] << 24) + (rsp[ptr+21] << 16) + (rsp[ptr+22] << 8) + rsp[ptr+23]; |
phonemacro | 12:17a0bf823462 | 246 | iadj1_rqt = rsp[ptr+24]; |
phonemacro | 12:17a0bf823462 | 247 | iadj1 = (rsp[ptr+25] << 8) + rsp[ptr+26]; |
phonemacro | 12:17a0bf823462 | 248 | |
phonemacro | 12:17a0bf823462 | 249 | iadj2_rqt = rsp[ptr+27]; |
phonemacro | 12:17a0bf823462 | 250 | iadj2 = (rsp[ptr+28] << 8) + rsp[ptr+29]; |
phonemacro | 12:17a0bf823462 | 251 | iadj3_rqt = rsp[ptr+30]; |
phonemacro | 12:17a0bf823462 | 252 | iadj3 = (rsp[ptr+31] << 8) + rsp[ptr+32]; |
phonemacro | 12:17a0bf823462 | 253 | |
phonemacro | 12:17a0bf823462 | 254 | intadj_rqt = rsp[ptr+33]; |
phonemacro | 12:17a0bf823462 | 255 | intadj = rsp[ptr+34]; |
phonemacro | 12:17a0bf823462 | 256 | smpladj_rqt = rsp[ptr+35]; |
phonemacro | 12:17a0bf823462 | 257 | smpladj = rsp[ptr+36]; |
phonemacro | 12:17a0bf823462 | 258 | |
phonemacro | 12:17a0bf823462 | 259 | rqt_smplave = rsp[ptr+37]; |
phonemacro | 12:17a0bf823462 | 260 | afestatehr = rsp[ptr+38]; |
phonemacro | 12:17a0bf823462 | 261 | hr_motion = rsp[ptr+39]; |
phonemacro | 12:17a0bf823462 | 262 | scd = rsp[ptr+40]; |
phonemacro | 12:17a0bf823462 | 263 | |
phonemacro | 12:17a0bf823462 | 264 | |
phonemacro | 12:17a0bf823462 | 265 | r = (rsp[ptr+41] << 8) + rsp[ptr+42]; |
phonemacro | 12:17a0bf823462 | 266 | spo2_conf = rsp[ptr+43]; |
phonemacro | 12:17a0bf823462 | 267 | |
phonemacro | 12:17a0bf823462 | 268 | spo2 = (rsp[ptr+44] << 8) + rsp[ptr+45]; |
phonemacro | 12:17a0bf823462 | 269 | spo2_compl = rsp[ptr+46]; |
phonemacro | 12:17a0bf823462 | 270 | spo2_lo = rsp[ptr+47]; |
phonemacro | 12:17a0bf823462 | 271 | spo2_mo = rsp[ptr+48]; |
phonemacro | 12:17a0bf823462 | 272 | |
phonemacro | 12:17a0bf823462 | 273 | spo2_lopi = rsp[ptr+49]; |
phonemacro | 12:17a0bf823462 | 274 | spo2_unrel = rsp[ptr+50]; |
phonemacro | 12:17a0bf823462 | 275 | spo2_state = rsp[ptr+51]; |
phonemacro | 12:17a0bf823462 | 276 | |
phonemacro | 12:17a0bf823462 | 277 | ibi_offset = rsp[ptr+52]; |
phonemacro | 12:17a0bf823462 | 278 | |
phonemacro | 12:17a0bf823462 | 279 | sptr += (TTL_SZ); |
phonemacro | 12:17a0bf823462 | 280 | #if 1 |
phonemacro | 12:17a0bf823462 | 281 | pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi); |
phonemacro | 12:17a0bf823462 | 282 | pc.printf("%d,%d,", ibi_conf, act); |
phonemacro | 12:17a0bf823462 | 283 | pc.printf("%d,%d,%d,", walk_stp, run_stp, energy); |
phonemacro | 12:17a0bf823462 | 284 | pc.printf("%d,%d,%d,%d,", amr, iadj1_rqt, iadj1, iadj2_rqt); |
phonemacro | 12:17a0bf823462 | 285 | pc.printf("%d,%d,%d,%d,", iadj2, iadj3_rqt, iadj3, intadj_rqt); |
phonemacro | 12:17a0bf823462 | 286 | pc.printf("%d,%d,%d,%d,", intadj, smpladj_rqt, smpladj, rqt_smplave); |
phonemacro | 12:17a0bf823462 | 287 | pc.printf("%d,%d,", afestatehr, hr_motion); |
phonemacro | 12:17a0bf823462 | 288 | pc.printf("%d,", scd); |
phonemacro | 12:17a0bf823462 | 289 | pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo); |
phonemacro | 12:17a0bf823462 | 290 | pc.printf("%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state); |
phonemacro | 12:17a0bf823462 | 291 | pc.printf("%d,", ibi_offset); |
phonemacro | 12:17a0bf823462 | 292 | #else |
phonemacro | 12:17a0bf823462 | 293 | pc.printf("%d,%d,", hr, hr_conf); |
phonemacro | 12:17a0bf823462 | 294 | pc.printf("%d,%d,", spo2, spo2_conf); |
phonemacro | 16:ff1122f0624a | 295 | pc.printf("%d,%d,%d,", spo2_lo, spo2_mo, spo2_lopi); |
phonemacro | 12:17a0bf823462 | 296 | pc.printf("%d,%d,", spo2_unrel, scd); |
phonemacro | 12:17a0bf823462 | 297 | #endif |
phonemacro | 12:17a0bf823462 | 298 | #else // normal algo size |
phonemacro | 12:17a0bf823462 | 299 | // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ); |
phonemacro | 12:17a0bf823462 | 300 | opmode = rsp[ptr]; |
phonemacro | 12:17a0bf823462 | 301 | hr = (rsp[ptr+1] << 8) + rsp[ptr+2]; |
phonemacro | 12:17a0bf823462 | 302 | hr_conf = rsp[ptr+3]; |
phonemacro | 12:17a0bf823462 | 303 | ibi = (rsp[ptr+4] << 8) + rsp[ptr+5]; |
phonemacro | 4:4f1e9439f048 | 304 | |
phonemacro | 11:a16b6bf38841 | 305 | ibi_conf = rsp[ptr+6]; |
phonemacro | 3:da975696b936 | 306 | act = rsp[ptr+7]; |
phonemacro | 3:da975696b936 | 307 | r = (rsp[ptr+8] << 8) + rsp[ptr+9]; |
phonemacro | 0:6f65cae31c54 | 308 | spo2_conf = rsp[ptr+10]; |
phonemacro | 4:4f1e9439f048 | 309 | |
phonemacro | 0:6f65cae31c54 | 310 | spo2 = (rsp[ptr+11] << 8) + rsp[ptr+12]; |
phonemacro | 4:4f1e9439f048 | 311 | spo2_compl = rsp[ptr+13]; |
phonemacro | 4:4f1e9439f048 | 312 | spo2_lo = rsp[ptr+14]; |
phonemacro | 4:4f1e9439f048 | 313 | spo2_mo = rsp[ptr+15]; |
phonemacro | 4:4f1e9439f048 | 314 | |
phonemacro | 4:4f1e9439f048 | 315 | spo2_lopi = rsp[ptr+16]; |
phonemacro | 4:4f1e9439f048 | 316 | spo2_unrel = rsp[ptr+17]; |
phonemacro | 4:4f1e9439f048 | 317 | spo2_state = rsp[ptr+18]; |
phonemacro | 2:563d90a111b3 | 318 | scd = rsp[ptr+19]; |
phonemacro | 0:6f65cae31c54 | 319 | |
phonemacro | 4:4f1e9439f048 | 320 | ibi_offset = rsp[ptr+20]; |
phonemacro | 0:6f65cae31c54 | 321 | |
phonemacro | 4:4f1e9439f048 | 322 | sptr += (TTL_SZ); |
phonemacro | 26:33c0d3fd2a95 | 323 | #if 1 |
phonemacro | 4:4f1e9439f048 | 324 | pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi); |
phonemacro | 4:4f1e9439f048 | 325 | pc.printf("%d,%d,%d,%d,", ibi_conf, act, r, spo2_conf); |
phonemacro | 4:4f1e9439f048 | 326 | pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo); |
phonemacro | 4:4f1e9439f048 | 327 | pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state, scd); |
phonemacro | 4:4f1e9439f048 | 328 | pc.printf("%d,", ibi_offset); |
phonemacro | 4:4f1e9439f048 | 329 | #else |
phonemacro | 4:4f1e9439f048 | 330 | pc.printf("%d,%d,", hr, hr_conf); |
phonemacro | 4:4f1e9439f048 | 331 | pc.printf("%d,%d,", spo2, spo2_conf); |
phonemacro | 4:4f1e9439f048 | 332 | pc.printf("%d,", spo2_lo); |
phonemacro | 4:4f1e9439f048 | 333 | pc.printf("%d,%d,", spo2_unrel, scd); |
phonemacro | 4:4f1e9439f048 | 334 | #endif |
phonemacro | 12:17a0bf823462 | 335 | #endif // end normal algo size |
phonemacro | 14:c8cc6d7fd5f9 | 336 | #endif // !RAW |
phonemacro | 4:4f1e9439f048 | 337 | |
phonemacro | 3:da975696b936 | 338 | pc.printf("\n\r"); |
phonemacro | 0:6f65cae31c54 | 339 | } |
phonemacro | 0:6f65cae31c54 | 340 | } |
phonemacro | 0:6f65cae31c54 | 341 | |
phonemacro | 6:e1b7190d6cb5 | 342 | #ifdef MAXREFDES103_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 343 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 344 | // init_max20303_pmic |
phonemacro | 14:c8cc6d7fd5f9 | 345 | /*****************************************************************************/ |
phonemacro | 6:e1b7190d6cb5 | 346 | void init_max20303_pmic(void) { |
phonemacro | 5:7f5a012747a5 | 347 | /* Wait for pmic to settle down */ |
phonemacro | 5:7f5a012747a5 | 348 | thread_sleep_for(800); |
phonemacro | 5:7f5a012747a5 | 349 | |
phonemacro | 5:7f5a012747a5 | 350 | //set_time(1544787300); // Set RTC time to Wed, 28 Oct 2009 11:35:37 |
phonemacro | 6:e1b7190d6cb5 | 351 | MAX20303 max20303(&sh_i2c); |
phonemacro | 5:7f5a012747a5 | 352 | /*Set LDO1 to 1.8v*/ |
phonemacro | 5:7f5a012747a5 | 353 | max20303.LDO1Config(); |
phonemacro | 5:7f5a012747a5 | 354 | |
phonemacro | 5:7f5a012747a5 | 355 | /*Set LDO2 to 3v*/ |
phonemacro | 5:7f5a012747a5 | 356 | max20303.LDO2Config(); |
phonemacro | 5:7f5a012747a5 | 357 | |
phonemacro | 5:7f5a012747a5 | 358 | //max20303.BoostEnable(); |
phonemacro | 5:7f5a012747a5 | 359 | max20303.BuckBoostEnable(); |
phonemacro | 5:7f5a012747a5 | 360 | |
phonemacro | 5:7f5a012747a5 | 361 | max20303.led0on(0); |
phonemacro | 5:7f5a012747a5 | 362 | max20303.led1on(0); |
phonemacro | 5:7f5a012747a5 | 363 | max20303.led2on(0); |
phonemacro | 5:7f5a012747a5 | 364 | |
phonemacro | 5:7f5a012747a5 | 365 | /* Wait for pmic to settle down */ |
phonemacro | 5:7f5a012747a5 | 366 | thread_sleep_for(200); |
phonemacro | 6:e1b7190d6cb5 | 367 | |
phonemacro | 5:7f5a012747a5 | 368 | } |
phonemacro | 6:e1b7190d6cb5 | 369 | #endif // MAXREFDES103_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 370 | |
phonemacro | 14:c8cc6d7fd5f9 | 371 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 372 | // init_sh_algo |
phonemacro | 14:c8cc6d7fd5f9 | 373 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 374 | void init_sh_algo(void) { |
phonemacro | 14:c8cc6d7fd5f9 | 375 | char cmd[8]; |
phonemacro | 0:6f65cae31c54 | 376 | char rsp[256]; |
phonemacro | 10:192ea88e964b | 377 | // switch to application mode |
phonemacro | 0:6f65cae31c54 | 378 | rst = 0; |
phonemacro | 0:6f65cae31c54 | 379 | mfio = 1; |
phonemacro | 0:6f65cae31c54 | 380 | thread_sleep_for(10); |
phonemacro | 0:6f65cae31c54 | 381 | rst = 1; |
phonemacro | 0:6f65cae31c54 | 382 | thread_sleep_for(1500); |
phonemacro | 10:192ea88e964b | 383 | #ifdef MAXREFDES103_CFG |
phonemacro | 10:192ea88e964b | 384 | init_max20303_pmic(); |
phonemacro | 10:192ea88e964b | 385 | #endif |
phonemacro | 23:e7ecf1416965 | 386 | #if 0 // 1.5s is ok for 33.13.12 |
phonemacro | 23:e7ecf1416965 | 387 | thread_sleep_for(250); |
phonemacro | 20:7fc26287beb7 | 388 | #endif |
phonemacro | 0:6f65cae31c54 | 389 | |
phonemacro | 1:da792e46a385 | 390 | mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 391 | |
phonemacro | 4:4f1e9439f048 | 392 | //read operating mode |
phonemacro | 4:4f1e9439f048 | 393 | cmd[0] = 0x02; cmd[1] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 394 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 1:da792e46a385 | 395 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 396 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 6:e1b7190d6cb5 | 397 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 398 | pc.printf("\n\r 0x02 0x00 Status, Read Operating Mode: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 5:7f5a012747a5 | 399 | //1.11 rd ver |
phonemacro | 4:4f1e9439f048 | 400 | cmd[0] = 0xFF; cmd[1] = 0x03; |
phonemacro | 6:e1b7190d6cb5 | 401 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 1:da792e46a385 | 402 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 403 | sh_i2c.read(SH_ADDR, rsp, 4); |
phonemacro | 1:da792e46a385 | 404 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 405 | pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]); |
phonemacro | 0:6f65cae31c54 | 406 | |
phonemacro | 17:0d6e99a0fd8d | 407 | #if 0 |
phonemacro | 17:0d6e99a0fd8d | 408 | // algo sz |
phonemacro | 17:0d6e99a0fd8d | 409 | cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x01; |
phonemacro | 17:0d6e99a0fd8d | 410 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 17:0d6e99a0fd8d | 411 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 412 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 17:0d6e99a0fd8d | 413 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 414 | pc.printf("algo size: %d %d \n\r", rsp[0], rsp[1]); |
phonemacro | 17:0d6e99a0fd8d | 415 | |
phonemacro | 17:0d6e99a0fd8d | 416 | // algo sz |
phonemacro | 17:0d6e99a0fd8d | 417 | cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x02; |
phonemacro | 17:0d6e99a0fd8d | 418 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 17:0d6e99a0fd8d | 419 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 420 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 17:0d6e99a0fd8d | 421 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 422 | pc.printf("algo size: %d %d \n\r", rsp[0], rsp[1]); |
phonemacro | 17:0d6e99a0fd8d | 423 | |
phonemacro | 17:0d6e99a0fd8d | 424 | // algo sz |
phonemacro | 17:0d6e99a0fd8d | 425 | cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x03; |
phonemacro | 17:0d6e99a0fd8d | 426 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 17:0d6e99a0fd8d | 427 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 428 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 17:0d6e99a0fd8d | 429 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 430 | pc.printf("algo size: %d %d \n\r", rsp[0], rsp[1]); |
phonemacro | 17:0d6e99a0fd8d | 431 | #endif |
phonemacro | 17:0d6e99a0fd8d | 432 | |
phonemacro | 17:0d6e99a0fd8d | 433 | #if 0 |
phonemacro | 17:0d6e99a0fd8d | 434 | // set Perfusion Index threshold to .05 (3x.13.19+) |
phonemacro | 17:0d6e99a0fd8d | 435 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x1D; cmd[3] = 50; |
phonemacro | 16:ff1122f0624a | 436 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 16:ff1122f0624a | 437 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 16:ff1122f0624a | 438 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 16:ff1122f0624a | 439 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 16:ff1122f0624a | 440 | pc.printf("pi set to 0x19 : %x \n\r", rsp[0]); |
phonemacro | 17:0d6e99a0fd8d | 441 | #endif |
phonemacro | 16:ff1122f0624a | 442 | |
phonemacro | 0:6f65cae31c54 | 443 | // 1.3 sensor and algo data |
phonemacro | 4:4f1e9439f048 | 444 | cmd[0] = 0x10; cmd[1] = 0x00; |
phonemacro | 2:563d90a111b3 | 445 | #ifdef ALGO_ONLY |
phonemacro | 0:6f65cae31c54 | 446 | cmd[2] = 0x02; // algo data |
phonemacro | 4:4f1e9439f048 | 447 | pc.printf("algo only \n\r"); |
phonemacro | 2:563d90a111b3 | 448 | #else |
phonemacro | 2:563d90a111b3 | 449 | cmd[2] = 0x03; // sensor + algo data |
phonemacro | 4:4f1e9439f048 | 450 | pc.printf("sens+algo \n\r"); |
phonemacro | 2:563d90a111b3 | 451 | #endif |
phonemacro | 6:e1b7190d6cb5 | 452 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 1:da792e46a385 | 453 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 454 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 455 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 456 | pc.printf("1.3 Status: %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 457 | // 1.7 cont hr, spo2 |
phonemacro | 4:4f1e9439f048 | 458 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0A; cmd[3] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 459 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 3:da975696b936 | 460 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 461 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 462 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 463 | pc.printf("1.7 Status: %x\n\r", rsp[0]); |
phonemacro | 4:4f1e9439f048 | 464 | // 1.8 AEC enable (default) |
phonemacro | 4:4f1e9439f048 | 465 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0B; cmd[3] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 466 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 1:da792e46a385 | 467 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 468 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 469 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 470 | pc.printf("1.8 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 471 | #if AGC |
phonemacro | 13:1baccc6275a7 | 472 | // AGC1.8 Disable auto PD (default |
phonemacro | 13:1baccc6275a7 | 473 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x00; |
phonemacro | 13:1baccc6275a7 | 474 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 13:1baccc6275a7 | 475 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 476 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 13:1baccc6275a7 | 477 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 478 | pc.printf("AGC1.8 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 479 | // AGC1.9 Disable SCD (default) |
phonemacro | 13:1baccc6275a7 | 480 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x00; |
phonemacro | 13:1baccc6275a7 | 481 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 13:1baccc6275a7 | 482 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 483 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 13:1baccc6275a7 | 484 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 485 | pc.printf("AGC1.9 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 486 | // AGC1.10 Set AGC target PD TO 10uA |
phonemacro | 13:1baccc6275a7 | 487 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x11; cmd[3] = 0x00; cmd[3] = 0x64; |
phonemacro | 13:1baccc6275a7 | 488 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 13:1baccc6275a7 | 489 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 490 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 13:1baccc6275a7 | 491 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 492 | pc.printf("AGC1.10 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 493 | #else |
phonemacro | 4:4f1e9439f048 | 494 | // 1.9 auto PD (default |
phonemacro | 4:4f1e9439f048 | 495 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 496 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 1:da792e46a385 | 497 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 498 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 499 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 500 | pc.printf("1.9 Status: %x\n\r", rsp[0]); |
phonemacro | 4:4f1e9439f048 | 501 | // 1.10 SCD (default) |
phonemacro | 4:4f1e9439f048 | 502 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 503 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 4:4f1e9439f048 | 504 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 505 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 4:4f1e9439f048 | 506 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 507 | pc.printf("1.7 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 508 | #endif |
phonemacro | 3:da975696b936 | 509 | #ifdef MAXM86146_CFG |
phonemacro | 3:da975696b936 | 510 | //1.20 Sec 4.1 map leds to slots for MAXM86146 |
phonemacro | 4:4f1e9439f048 | 511 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x13; cmd[4] = 0x56; cmd[5] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 512 | sh_i2c.write(SH_ADDR, cmd, 6); |
phonemacro | 3:da975696b936 | 513 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 514 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 515 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 516 | pc.printf("map leds to slots %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 517 | //1.21 map HR inputs to slots |
phonemacro | 4:4f1e9439f048 | 518 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x11; |
phonemacro | 6:e1b7190d6cb5 | 519 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 3:da975696b936 | 520 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 521 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 522 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 523 | pc.printf("map HR to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 524 | //1.22 map SpO2 inputs to slots |
phonemacro | 4:4f1e9439f048 | 525 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x30; cmd[4] = 0x20; |
phonemacro | 6:e1b7190d6cb5 | 526 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 3:da975696b936 | 527 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 528 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 529 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 530 | pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 26:33c0d3fd2a95 | 531 | |
phonemacro | 3:da975696b936 | 532 | #if 0 |
phonemacro | 2:563d90a111b3 | 533 | //1.20 Sec 4.1 map leds to slots for MAXM86146 |
phonemacro | 4:4f1e9439f048 | 534 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x15; cmd[4] = 0x60; cmd[5] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 535 | sh_i2c.write(SH_ADDR, cmd, 6); |
phonemacro | 1:da792e46a385 | 536 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 537 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 538 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 539 | pc.printf("map leds to slots%x\n\r", rsp[0]); |
phonemacro | 2:563d90a111b3 | 540 | //1.21 map HR inputs to slots |
phonemacro | 4:4f1e9439f048 | 541 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 542 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 1:da792e46a385 | 543 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 544 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 545 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 546 | pc.printf("map HR to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 2:563d90a111b3 | 547 | //1.22 map SpO2 inputs to slots |
phonemacro | 4:4f1e9439f048 | 548 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x20; cmd[4] = 0x10; |
phonemacro | 6:e1b7190d6cb5 | 549 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 1:da792e46a385 | 550 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 551 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 552 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 553 | pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 554 | #endif |
phonemacro | 3:da975696b936 | 555 | #endif // MAXM86146_CFG |
phonemacro | 0:6f65cae31c54 | 556 | |
phonemacro | 4:4f1e9439f048 | 557 | // 1.3 Enable HR, SpO2 algo |
phonemacro | 12:17a0bf823462 | 558 | #ifdef EXTENDED_ALGO |
phonemacro | 12:17a0bf823462 | 559 | cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x02; |
phonemacro | 12:17a0bf823462 | 560 | #else |
phonemacro | 4:4f1e9439f048 | 561 | cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x01; |
phonemacro | 12:17a0bf823462 | 562 | #endif |
phonemacro | 6:e1b7190d6cb5 | 563 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 26:33c0d3fd2a95 | 564 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 0:6f65cae31c54 | 565 | thread_sleep_for(465); |
phonemacro | 26:33c0d3fd2a95 | 566 | thread_sleep_for(465); |
phonemacro | 26:33c0d3fd2a95 | 567 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 568 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 569 | pc.printf("1.14 status: %x\n\r", rsp[0]); |
phonemacro | 0:6f65cae31c54 | 570 | |
phonemacro | 4:4f1e9439f048 | 571 | #if 1 |
phonemacro | 4:4f1e9439f048 | 572 | //1.31 rd AFE part id |
phonemacro | 4:4f1e9439f048 | 573 | cmd[0] = 0x41; cmd[1] = 0x00; cmd[2] = 0xFF; |
phonemacro | 6:e1b7190d6cb5 | 574 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 4:4f1e9439f048 | 575 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 576 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 4:4f1e9439f048 | 577 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 578 | pc.printf("1.31 part id afe %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 4:4f1e9439f048 | 579 | //1.32 rd accel who |
phonemacro | 4:4f1e9439f048 | 580 | cmd[0] = 0x41; cmd[1] = 0x04; cmd[2] = 0x0F; |
phonemacro | 6:e1b7190d6cb5 | 581 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 4:4f1e9439f048 | 582 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 583 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 4:4f1e9439f048 | 584 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 585 | pc.printf("1.32 who accel %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 26:33c0d3fd2a95 | 586 | |
phonemacro | 26:33c0d3fd2a95 | 587 | mfio = 1; |
phonemacro | 4:4f1e9439f048 | 588 | #endif |
phonemacro | 10:192ea88e964b | 589 | } |
phonemacro | 10:192ea88e964b | 590 | |
phonemacro | 14:c8cc6d7fd5f9 | 591 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 592 | // init_sh_raw |
phonemacro | 14:c8cc6d7fd5f9 | 593 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 594 | void init_sh_raw(void) { |
phonemacro | 14:c8cc6d7fd5f9 | 595 | char cmd[8]; |
phonemacro | 14:c8cc6d7fd5f9 | 596 | char rsp[256]; |
phonemacro | 14:c8cc6d7fd5f9 | 597 | // switch to application mode |
phonemacro | 14:c8cc6d7fd5f9 | 598 | rst = 0; |
phonemacro | 14:c8cc6d7fd5f9 | 599 | mfio = 1; |
phonemacro | 14:c8cc6d7fd5f9 | 600 | thread_sleep_for(10); |
phonemacro | 14:c8cc6d7fd5f9 | 601 | rst = 1; |
phonemacro | 14:c8cc6d7fd5f9 | 602 | thread_sleep_for(1500); |
phonemacro | 14:c8cc6d7fd5f9 | 603 | #ifdef MAXREFDES103_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 604 | init_max20303_pmic(); |
phonemacro | 14:c8cc6d7fd5f9 | 605 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 606 | |
phonemacro | 14:c8cc6d7fd5f9 | 607 | mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 608 | |
phonemacro | 14:c8cc6d7fd5f9 | 609 | //read operating mode |
phonemacro | 14:c8cc6d7fd5f9 | 610 | cmd[0] = 0x02; cmd[1] = 0x00; |
phonemacro | 14:c8cc6d7fd5f9 | 611 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 14:c8cc6d7fd5f9 | 612 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 613 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 14:c8cc6d7fd5f9 | 614 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 615 | pc.printf("\n\r 0x02 0x00 Status, Read Operating Mode: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 14:c8cc6d7fd5f9 | 616 | //1.11 rd ver |
phonemacro | 14:c8cc6d7fd5f9 | 617 | cmd[0] = 0xFF; cmd[1] = 0x03; |
phonemacro | 14:c8cc6d7fd5f9 | 618 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 14:c8cc6d7fd5f9 | 619 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 620 | sh_i2c.read(SH_ADDR, rsp, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 621 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 622 | pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]); |
phonemacro | 14:c8cc6d7fd5f9 | 623 | |
phonemacro | 14:c8cc6d7fd5f9 | 624 | // raw1.1 sensor data |
phonemacro | 14:c8cc6d7fd5f9 | 625 | cmd[0] = 0x10; cmd[1] = 0x00; cmd[2] = 0x01; |
phonemacro | 14:c8cc6d7fd5f9 | 626 | pc.printf("raw sensor data only \n\r"); |
phonemacro | 14:c8cc6d7fd5f9 | 627 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 14:c8cc6d7fd5f9 | 628 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 629 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 630 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 631 | pc.printf("raw1.1 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 632 | // raw1.2 interrupt threshold |
phonemacro | 14:c8cc6d7fd5f9 | 633 | cmd[0] = 0x10; cmd[1] = 0x01; cmd[2] = 0x01; |
phonemacro | 14:c8cc6d7fd5f9 | 634 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 14:c8cc6d7fd5f9 | 635 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 636 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 637 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 638 | pc.printf("raw1.2 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 639 | // raw1.3 enable sh accel |
phonemacro | 14:c8cc6d7fd5f9 | 640 | cmd[0] = 0x44; cmd[1] = 0x04; cmd[2] = 0x01; cmd[3] = 0x00; |
phonemacro | 14:c8cc6d7fd5f9 | 641 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 642 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 643 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 644 | mfio = 1; thread_sleep_for(20); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 645 | pc.printf("raw1.3 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 646 | // raw1.4 enable AFE |
phonemacro | 14:c8cc6d7fd5f9 | 647 | cmd[0] = 0x44; cmd[1] = 0x00; cmd[2] = 0x01; cmd[3] = 0x00; |
phonemacro | 14:c8cc6d7fd5f9 | 648 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 649 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 650 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 651 | mfio = 1; thread_sleep_for(250); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 652 | pc.printf("raw1.4 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 653 | // raw1.5 sample rate 100 Hz, ave 1 |
phonemacro | 14:c8cc6d7fd5f9 | 654 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x18; // set AFE reg 0x12 to 100 Hz |
phonemacro | 14:c8cc6d7fd5f9 | 655 | // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x20; // set AFE reg 0x12 to 200 Hz |
phonemacro | 14:c8cc6d7fd5f9 | 656 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 657 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 658 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 659 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 660 | pc.printf("raw1.5 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 661 | // raw1.6 LED1 current |
phonemacro | 14:c8cc6d7fd5f9 | 662 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 663 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 664 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 665 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 666 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 667 | pc.printf("raw1.6 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 668 | #ifndef MAXM86146_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 669 | // raw1.7 LED2 current |
phonemacro | 14:c8cc6d7fd5f9 | 670 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 671 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 672 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 673 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 674 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 675 | pc.printf("raw1.7 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 676 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 677 | // raw1.8 LED3 current |
phonemacro | 14:c8cc6d7fd5f9 | 678 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 679 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 680 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 681 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 682 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 683 | pc.printf("raw1.8 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 684 | #ifdef MAXM86146_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 685 | // LED5 current |
phonemacro | 14:c8cc6d7fd5f9 | 686 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 687 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 688 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 689 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 690 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 691 | pc.printf("led5 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 692 | // LED6 current |
phonemacro | 14:c8cc6d7fd5f9 | 693 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 694 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 695 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 696 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 697 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 698 | pc.printf("led6 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 699 | |
phonemacro | 14:c8cc6d7fd5f9 | 700 | // Set Seq cntrl1 LED2, LED1 |
phonemacro | 14:c8cc6d7fd5f9 | 701 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x20; cmd[3] = 0x21; |
phonemacro | 14:c8cc6d7fd5f9 | 702 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 703 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 704 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 705 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 706 | pc.printf("Seq cntrl1 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 707 | // Set Seq cntrl2 LED4, LED3 |
phonemacro | 14:c8cc6d7fd5f9 | 708 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x21; cmd[3] = 0xA3; |
phonemacro | 14:c8cc6d7fd5f9 | 709 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 710 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 711 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 712 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 713 | pc.printf("Seq cntrl2 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 714 | // Set Seq cntrl3 LED6, LED5 |
phonemacro | 14:c8cc6d7fd5f9 | 715 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x21; |
phonemacro | 14:c8cc6d7fd5f9 | 716 | // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x99; // Ambient |
phonemacro | 14:c8cc6d7fd5f9 | 717 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 718 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 719 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 720 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 721 | pc.printf("Seq cntrl3 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 722 | |
phonemacro | 14:c8cc6d7fd5f9 | 723 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 724 | } |
phonemacro | 14:c8cc6d7fd5f9 | 725 | |
phonemacro | 14:c8cc6d7fd5f9 | 726 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 727 | // main |
phonemacro | 14:c8cc6d7fd5f9 | 728 | /*****************************************************************************/ |
phonemacro | 10:192ea88e964b | 729 | int main() |
phonemacro | 10:192ea88e964b | 730 | { |
phonemacro | 10:192ea88e964b | 731 | sh_i2c.frequency(400000); |
phonemacro | 10:192ea88e964b | 732 | int32_t ledcnt = 0; |
phonemacro | 10:192ea88e964b | 733 | rLED = LED_OFF; gLED = LED_ON; bLED = LED_OFF; |
phonemacro | 10:192ea88e964b | 734 | Ticker ticker; // calls a callback repeatedly with a timeout |
phonemacro | 10:192ea88e964b | 735 | //ticker.attach(callback(&blink_timer), BLINKING_RATE_MS); /* set timer for one second */ |
phonemacro | 14:c8cc6d7fd5f9 | 736 | #ifdef RAW |
phonemacro | 14:c8cc6d7fd5f9 | 737 | init_sh_raw(); |
phonemacro | 14:c8cc6d7fd5f9 | 738 | #else |
phonemacro | 14:c8cc6d7fd5f9 | 739 | init_sh_algo(); |
phonemacro | 14:c8cc6d7fd5f9 | 740 | #endif |
phonemacro | 8:e6ae69cfecbf | 741 | #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG) || defined(MAXM86146_CFG) |
phonemacro | 6:e1b7190d6cb5 | 742 | Timer tmr1; |
phonemacro | 0:6f65cae31c54 | 743 | while (1) { |
phonemacro | 6:e1b7190d6cb5 | 744 | tmr1.start(); |
phonemacro | 6:e1b7190d6cb5 | 745 | if (tmr1.read_ms() > 40) { |
phonemacro | 7:23b067817ab8 | 746 | tmr1.reset(); |
phonemacro | 10:192ea88e964b | 747 | read_sh_fifo(); |
phonemacro | 7:23b067817ab8 | 748 | if ((ledcnt++ % 50) == 0) |
phonemacro | 6:e1b7190d6cb5 | 749 | gLED = !gLED; |
phonemacro | 0:6f65cae31c54 | 750 | } |
phonemacro | 0:6f65cae31c54 | 751 | } |
phonemacro | 6:e1b7190d6cb5 | 752 | #else |
phonemacro | 6:e1b7190d6cb5 | 753 | ticker.attach(callback(&fifo_timer), 0.040f); |
phonemacro | 6:e1b7190d6cb5 | 754 | while (1) { |
phonemacro | 6:e1b7190d6cb5 | 755 | if (Time_to_Read_PPG) { |
phonemacro | 10:192ea88e964b | 756 | read_sh_fifo(); |
phonemacro | 7:23b067817ab8 | 757 | if ((ledcnt++ % 50) == 0) |
phonemacro | 6:e1b7190d6cb5 | 758 | gLED = !gLED; |
phonemacro | 6:e1b7190d6cb5 | 759 | } |
phonemacro | 6:e1b7190d6cb5 | 760 | } |
phonemacro | 6:e1b7190d6cb5 | 761 | #endif |
phonemacro | 0:6f65cae31c54 | 762 | } |