David Jung
/
MAX32664C_MAXM86146_Mode1_Optical
Mode1 Optical Validation
main.cpp@17:0d6e99a0fd8d, 2021-06-10 (annotated)
- Committer:
- phonemacro
- Date:
- Thu Jun 10 23:25:26 2021 +0000
- Revision:
- 17:0d6e99a0fd8d
- Parent:
- 16:ff1122f0624a
- Child:
- 18:f4c95b1c0efc
added 3.3v gpio
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 | 16:ff1122f0624a | 40 | * ver: 210525 |
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 | 6:e1b7190d6cb5 | 52 | /*****************************************************************************/ |
phonemacro | 6:e1b7190d6cb5 | 53 | // define one and only one of the following three platforms |
phonemacro | 11:a16b6bf38841 | 54 | #define MAXM86146_CFG 1 // tested on MAXM86146EVSYS_sensorBrd+MAXM86161_ADAPTER_REVB+MAX32630FTHR |
phonemacro | 12:17a0bf823462 | 55 | //#define MAXREFDES103_CFG |
phonemacro | 6:e1b7190d6cb5 | 56 | //#define MAX86161_CFG 1 |
phonemacro | 6:e1b7190d6cb5 | 57 | /*****************************************************************************/ |
phonemacro | 17:0d6e99a0fd8d | 58 | #include "max32630fthr.h" |
phonemacro | 17:0d6e99a0fd8d | 59 | MAX32630FTHR pegasus(MAX32630FTHR::VIO_3V3); // Enable J1-pin2, 3.3V and set GPIO to 3.3v |
phonemacro | 14:c8cc6d7fd5f9 | 60 | //#define RAW // define this if you only AFE+accel data, no algo |
phonemacro | 14:c8cc6d7fd5f9 | 61 | #define ALGO_ONLY 1 // define this if you only want algo data, comment out if you want raw sensor+algo data |
phonemacro | 12:17a0bf823462 | 62 | //#define EXTENDED_ALGO 1 // define this if you want the extended algo format |
phonemacro | 13:1baccc6275a7 | 63 | //#define AGC 1 // define this for AGC, otherwise the default is AEC |
phonemacro | 6:e1b7190d6cb5 | 64 | |
phonemacro | 6:e1b7190d6cb5 | 65 | #ifdef MAXREFDES103_CFG |
phonemacro | 5:7f5a012747a5 | 66 | #include "MAX20303.h" |
phonemacro | 6:e1b7190d6cb5 | 67 | I2C sh_i2c_pmic(P5_7, P6_0); |
phonemacro | 5:7f5a012747a5 | 68 | #endif |
phonemacro | 5:7f5a012747a5 | 69 | |
phonemacro | 2:563d90a111b3 | 70 | #ifdef MAXM86146_CFG |
phonemacro | 0:6f65cae31c54 | 71 | #define PPG_SZ 36 //maxm86146 |
phonemacro | 0:6f65cae31c54 | 72 | #else |
phonemacro | 0:6f65cae31c54 | 73 | #define PPG_SZ 18 //maxm86161, max86141 |
phonemacro | 0:6f65cae31c54 | 74 | #endif |
phonemacro | 0:6f65cae31c54 | 75 | #define ACCEL_SZ 6 // accel |
phonemacro | 0:6f65cae31c54 | 76 | #define SENSOR_SZ (PPG_SZ+ACCEL_SZ) |
phonemacro | 12:17a0bf823462 | 77 | #ifdef EXTENDED_ALGO |
phonemacro | 12:17a0bf823462 | 78 | //#define ALGO_SZ 52 // 52 bytes is the extended algo size for 3x.12.0 |
phonemacro | 12:17a0bf823462 | 79 | #define ALGO_SZ 56 // 56 bytes is the extended algo size for 3x.13.x |
phonemacro | 12:17a0bf823462 | 80 | #else |
phonemacro | 15:26dda33c2ef4 | 81 | //#define ALGO_SZ 20 // 20 bytes is the algo normal size for 3x.12.0 |
phonemacro | 12:17a0bf823462 | 82 | #define ALGO_SZ 24 // 24 bytes is the algo normal size for 3x.13.x |
phonemacro | 12:17a0bf823462 | 83 | #endif |
phonemacro | 0:6f65cae31c54 | 84 | #ifdef ALGO_ONLY |
phonemacro | 0:6f65cae31c54 | 85 | #define TTL_SZ (ALGO_SZ) |
phonemacro | 0:6f65cae31c54 | 86 | #else |
phonemacro | 14:c8cc6d7fd5f9 | 87 | #ifdef RAW |
phonemacro | 14:c8cc6d7fd5f9 | 88 | #define TTL_SZ (PPG_SZ+ACCEL_SZ) |
phonemacro | 14:c8cc6d7fd5f9 | 89 | #else |
phonemacro | 14:c8cc6d7fd5f9 | 90 | #define TTL_SZ (PPG_SZ+ACCEL_SZ+ALGO_SZ) |
phonemacro | 14:c8cc6d7fd5f9 | 91 | #endif |
phonemacro | 0:6f65cae31c54 | 92 | #endif |
phonemacro | 0:6f65cae31c54 | 93 | |
phonemacro | 3:da975696b936 | 94 | Serial pc(USBTX, USBRX, 115200); |
phonemacro | 0:6f65cae31c54 | 95 | DigitalOut rLED(LED1); |
phonemacro | 0:6f65cae31c54 | 96 | DigitalOut gLED(LED2); |
phonemacro | 0:6f65cae31c54 | 97 | DigitalOut bLED(LED3); |
phonemacro | 5:7f5a012747a5 | 98 | /****************************************************************************** |
phonemacro | 5:7f5a012747a5 | 99 | * MAX32630FTHR GPIOs |
phonemacro | 5:7f5a012747a5 | 100 | ******************************************************************************/ |
phonemacro | 0:6f65cae31c54 | 101 | #define RST_PIN P5_6 |
phonemacro | 0:6f65cae31c54 | 102 | #define MFIO_PIN P5_4 |
phonemacro | 0:6f65cae31c54 | 103 | DigitalOut rst(RST_PIN, PullUp); |
phonemacro | 0:6f65cae31c54 | 104 | DigitalOut mfio(MFIO_PIN, PullUp); |
phonemacro | 6:e1b7190d6cb5 | 105 | I2C sh_i2c(P3_4, P3_5); |
phonemacro | 6:e1b7190d6cb5 | 106 | |
phonemacro | 6:e1b7190d6cb5 | 107 | //#define thread_sleep_for(x) wait_ms(x) // for older versions of mbed |
phonemacro | 0:6f65cae31c54 | 108 | |
phonemacro | 5:7f5a012747a5 | 109 | |
phonemacro | 6:e1b7190d6cb5 | 110 | const int SH_ADDR = 0xAA;//0x55; |
phonemacro | 0:6f65cae31c54 | 111 | int32_t Time_to_Read_PPG = 0; |
phonemacro | 0:6f65cae31c54 | 112 | |
phonemacro | 0:6f65cae31c54 | 113 | #define BLINKING_RATE_MS 1000ms |
phonemacro | 0:6f65cae31c54 | 114 | void blink_timer(void) { |
phonemacro | 0:6f65cae31c54 | 115 | gLED = !gLED; /* blink the green LED */ |
phonemacro | 0:6f65cae31c54 | 116 | } |
phonemacro | 0:6f65cae31c54 | 117 | |
phonemacro | 0:6f65cae31c54 | 118 | void fifo_timer(void) { |
phonemacro | 0:6f65cae31c54 | 119 | Time_to_Read_PPG = 1; |
phonemacro | 0:6f65cae31c54 | 120 | } |
phonemacro | 0:6f65cae31c54 | 121 | |
phonemacro | 14:c8cc6d7fd5f9 | 122 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 123 | // read_sh_fifo |
phonemacro | 14:c8cc6d7fd5f9 | 124 | /*****************************************************************************/ |
phonemacro | 10:192ea88e964b | 125 | void read_sh_fifo(void) { |
phonemacro | 0:6f65cae31c54 | 126 | char cmd[8], i, j, samples; |
phonemacro | 0:6f65cae31c54 | 127 | char rsp[3000]; |
phonemacro | 0:6f65cae31c54 | 128 | int32_t ppg[12]; |
phonemacro | 5:7f5a012747a5 | 129 | int16_t accel[3]; |
phonemacro | 12:17a0bf823462 | 130 | int32_t status, opmode, hr, hr_conf, ibi, ibi_conf; |
phonemacro | 12:17a0bf823462 | 131 | #ifdef EXTENDED_ALGO |
phonemacro | 12:17a0bf823462 | 132 | int32_t walk_stp, run_stp, energy, amr, iadj1_rqt, iadj1, iadj2_rqt, iadj2, iadj3_rqt, iadj3; |
phonemacro | 12:17a0bf823462 | 133 | int32_t intadj_rqt, intadj, smpladj_rqt, smpladj, rqt_smplave, afestatehr, hr_motion; |
phonemacro | 12:17a0bf823462 | 134 | #endif |
phonemacro | 12:17a0bf823462 | 135 | int32_t act, r, spo2, spo2_conf; |
phonemacro | 4:4f1e9439f048 | 136 | int32_t spo2_compl, spo2_lo, spo2_mo, spo2_lopi, spo2_unrel, spo2_state, ibi_offset, scd; |
phonemacro | 2:563d90a111b3 | 137 | int32_t scnt = 0; |
phonemacro | 0:6f65cae31c54 | 138 | int32_t ptr = 0; |
phonemacro | 0:6f65cae31c54 | 139 | int32_t sptr = 0; |
phonemacro | 1:da792e46a385 | 140 | mfio = 0; wait_us(300); |
phonemacro | 0:6f65cae31c54 | 141 | Time_to_Read_PPG = 0; |
phonemacro | 0:6f65cae31c54 | 142 | #if 0 |
phonemacro | 0:6f65cae31c54 | 143 | // 2.1 |
phonemacro | 4:4f1e9439f048 | 144 | cmd[0] = 0x00; cmd[1] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 145 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 0:6f65cae31c54 | 146 | wait_us(100); |
phonemacro | 6:e1b7190d6cb5 | 147 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 3:da975696b936 | 148 | // pc.printf("2.1 Status: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 0:6f65cae31c54 | 149 | #endif |
phonemacro | 0:6f65cae31c54 | 150 | // 2.2 |
phonemacro | 4:4f1e9439f048 | 151 | cmd[0] = 0x12; cmd[1] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 152 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 0:6f65cae31c54 | 153 | wait_us(100); |
phonemacro | 6:e1b7190d6cb5 | 154 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 3:da975696b936 | 155 | // pc.printf("2.2 Status: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 0:6f65cae31c54 | 156 | samples = rsp[1]; |
phonemacro | 3:da975696b936 | 157 | // pc.printf("num samples %d, (num*ttl)+1 %d\n\r", rsp[1], TTL_SZ*samples+1); |
phonemacro | 3:da975696b936 | 158 | // pc.printf("num smpls %d \n\r", samples); |
phonemacro | 0:6f65cae31c54 | 159 | scnt = rsp[1]; |
phonemacro | 0:6f65cae31c54 | 160 | // 2.3 |
phonemacro | 4:4f1e9439f048 | 161 | cmd[0] = 0x12; cmd[1] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 162 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 0:6f65cae31c54 | 163 | wait_us(100); |
phonemacro | 0:6f65cae31c54 | 164 | // thread_sleep_for(1); |
phonemacro | 6:e1b7190d6cb5 | 165 | sh_i2c.read(SH_ADDR, rsp, 1+(TTL_SZ*samples)); |
phonemacro | 0:6f65cae31c54 | 166 | status = rsp[0]; |
phonemacro | 5:7f5a012747a5 | 167 | |
phonemacro | 0:6f65cae31c54 | 168 | sptr = 1; |
phonemacro | 0:6f65cae31c54 | 169 | for (i = 0; i < scnt; i++) { |
phonemacro | 0:6f65cae31c54 | 170 | #ifdef ALGO_ONLY |
phonemacro | 0:6f65cae31c54 | 171 | ptr = sptr; |
phonemacro | 0:6f65cae31c54 | 172 | #else |
phonemacro | 2:563d90a111b3 | 173 | ptr = sptr; |
phonemacro | 2:563d90a111b3 | 174 | ppg[0] = (rsp[ptr+0] << 16) | (rsp[ptr+1] << 8) | (rsp[ptr+2]); |
phonemacro | 2:563d90a111b3 | 175 | ppg[1] = (rsp[ptr+3] << 16) | (rsp[ptr+4] << 8) | (rsp[ptr+5]); |
phonemacro | 2:563d90a111b3 | 176 | ppg[2] = (rsp[ptr+6] << 16) | (rsp[ptr+7] << 8) | (rsp[ptr+8]); |
phonemacro | 3:da975696b936 | 177 | ppg[3] = (rsp[ptr+9] << 16) | (rsp[ptr+10] << 8) | (rsp[ptr+11]); |
phonemacro | 4:4f1e9439f048 | 178 | ppg[4] = (rsp[ptr+12] << 16) | (rsp[ptr+13] << 8) | (rsp[ptr+14]); |
phonemacro | 4:4f1e9439f048 | 179 | ppg[5] = (rsp[ptr+15] << 16) | (rsp[ptr+16] << 8) | (rsp[ptr+17]); |
phonemacro | 3:da975696b936 | 180 | pc.printf("%d,%d,%d,%d,", ppg[0], ppg[1], ppg[2], ppg[3]); |
phonemacro | 14:c8cc6d7fd5f9 | 181 | #ifdef MAXM86146_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 182 | #ifdef RAW |
phonemacro | 14:c8cc6d7fd5f9 | 183 | pc.printf("%d,%d,", ppg[4], ppg[5]); |
phonemacro | 14:c8cc6d7fd5f9 | 184 | ppg[6] = (rsp[ptr+18] << 16) | (rsp[ptr+19] << 8) | (rsp[ptr+20]); |
phonemacro | 14:c8cc6d7fd5f9 | 185 | ppg[7] = (rsp[ptr+21] << 16) | (rsp[ptr+22] << 8) | (rsp[ptr+23]); |
phonemacro | 14:c8cc6d7fd5f9 | 186 | ppg[8] = (rsp[ptr+24] << 16) | (rsp[ptr+25] << 8) | (rsp[ptr+26]); |
phonemacro | 14:c8cc6d7fd5f9 | 187 | ppg[9] = (rsp[ptr+27] << 16) | (rsp[ptr+28] << 8) | (rsp[ptr+29]); |
phonemacro | 14:c8cc6d7fd5f9 | 188 | ppg[10] = (rsp[ptr+30] << 16) | (rsp[ptr+31] << 8) | (rsp[ptr+32]); |
phonemacro | 14:c8cc6d7fd5f9 | 189 | ppg[11] = (rsp[ptr+33] << 16) | (rsp[ptr+34] << 8) | (rsp[ptr+35]); |
phonemacro | 14:c8cc6d7fd5f9 | 190 | pc.printf("%d,%d,%d,%d,%d,%d,", ppg[6], ppg[7],ppg[8], ppg[9],ppg[10], ppg[11]); |
phonemacro | 14:c8cc6d7fd5f9 | 191 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 192 | #endif |
phonemacro | 5:7f5a012747a5 | 193 | accel[0] = (rsp[PPG_SZ+0] << 8) | (rsp[PPG_SZ+1]); |
phonemacro | 5:7f5a012747a5 | 194 | accel[1] = (rsp[PPG_SZ+2] << 8) | (rsp[PPG_SZ+3]); |
phonemacro | 5:7f5a012747a5 | 195 | accel[2] = (rsp[PPG_SZ+4] << 8) | (rsp[PPG_SZ+5]); |
phonemacro | 5:7f5a012747a5 | 196 | pc.printf("%d,%d,%d,", accel[0], accel[1], accel[2]); |
phonemacro | 5:7f5a012747a5 | 197 | |
phonemacro | 0:6f65cae31c54 | 198 | ptr = sptr + SENSOR_SZ; |
phonemacro | 0:6f65cae31c54 | 199 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 200 | #ifndef RAW |
phonemacro | 12:17a0bf823462 | 201 | #ifdef EXTENDED_ALGO |
phonemacro | 3:da975696b936 | 202 | // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ); |
phonemacro | 0:6f65cae31c54 | 203 | opmode = rsp[ptr]; |
phonemacro | 0:6f65cae31c54 | 204 | hr = (rsp[ptr+1] << 8) + rsp[ptr+2]; |
phonemacro | 0:6f65cae31c54 | 205 | hr_conf = rsp[ptr+3]; |
phonemacro | 12:17a0bf823462 | 206 | ibi = (rsp[ptr+4] << 8) + rsp[ptr+5]; |
phonemacro | 12:17a0bf823462 | 207 | |
phonemacro | 12:17a0bf823462 | 208 | ibi_conf = rsp[ptr+6]; |
phonemacro | 12:17a0bf823462 | 209 | act = rsp[ptr+7]; |
phonemacro | 12:17a0bf823462 | 210 | walk_stp = (rsp[ptr+8] << 24) + (rsp[ptr+9] << 16) + (rsp[ptr+10] << 8) + rsp[ptr+11]; |
phonemacro | 12:17a0bf823462 | 211 | run_stp = (rsp[ptr+12] << 24) + (rsp[ptr+13] << 16) + (rsp[ptr+14] << 8) + rsp[ptr+15]; |
phonemacro | 12:17a0bf823462 | 212 | |
phonemacro | 12:17a0bf823462 | 213 | energy = (rsp[ptr+16] << 24) + (rsp[ptr+17] << 16) + (rsp[ptr+18] << 8) + rsp[ptr+19]; |
phonemacro | 12:17a0bf823462 | 214 | amr = (rsp[ptr+20] << 24) + (rsp[ptr+21] << 16) + (rsp[ptr+22] << 8) + rsp[ptr+23]; |
phonemacro | 12:17a0bf823462 | 215 | iadj1_rqt = rsp[ptr+24]; |
phonemacro | 12:17a0bf823462 | 216 | iadj1 = (rsp[ptr+25] << 8) + rsp[ptr+26]; |
phonemacro | 12:17a0bf823462 | 217 | |
phonemacro | 12:17a0bf823462 | 218 | iadj2_rqt = rsp[ptr+27]; |
phonemacro | 12:17a0bf823462 | 219 | iadj2 = (rsp[ptr+28] << 8) + rsp[ptr+29]; |
phonemacro | 12:17a0bf823462 | 220 | iadj3_rqt = rsp[ptr+30]; |
phonemacro | 12:17a0bf823462 | 221 | iadj3 = (rsp[ptr+31] << 8) + rsp[ptr+32]; |
phonemacro | 12:17a0bf823462 | 222 | |
phonemacro | 12:17a0bf823462 | 223 | intadj_rqt = rsp[ptr+33]; |
phonemacro | 12:17a0bf823462 | 224 | intadj = rsp[ptr+34]; |
phonemacro | 12:17a0bf823462 | 225 | smpladj_rqt = rsp[ptr+35]; |
phonemacro | 12:17a0bf823462 | 226 | smpladj = rsp[ptr+36]; |
phonemacro | 12:17a0bf823462 | 227 | |
phonemacro | 12:17a0bf823462 | 228 | rqt_smplave = rsp[ptr+37]; |
phonemacro | 12:17a0bf823462 | 229 | afestatehr = rsp[ptr+38]; |
phonemacro | 12:17a0bf823462 | 230 | hr_motion = rsp[ptr+39]; |
phonemacro | 12:17a0bf823462 | 231 | scd = rsp[ptr+40]; |
phonemacro | 12:17a0bf823462 | 232 | |
phonemacro | 12:17a0bf823462 | 233 | |
phonemacro | 12:17a0bf823462 | 234 | r = (rsp[ptr+41] << 8) + rsp[ptr+42]; |
phonemacro | 12:17a0bf823462 | 235 | spo2_conf = rsp[ptr+43]; |
phonemacro | 12:17a0bf823462 | 236 | |
phonemacro | 12:17a0bf823462 | 237 | spo2 = (rsp[ptr+44] << 8) + rsp[ptr+45]; |
phonemacro | 12:17a0bf823462 | 238 | spo2_compl = rsp[ptr+46]; |
phonemacro | 12:17a0bf823462 | 239 | spo2_lo = rsp[ptr+47]; |
phonemacro | 12:17a0bf823462 | 240 | spo2_mo = rsp[ptr+48]; |
phonemacro | 12:17a0bf823462 | 241 | |
phonemacro | 12:17a0bf823462 | 242 | spo2_lopi = rsp[ptr+49]; |
phonemacro | 12:17a0bf823462 | 243 | spo2_unrel = rsp[ptr+50]; |
phonemacro | 12:17a0bf823462 | 244 | spo2_state = rsp[ptr+51]; |
phonemacro | 12:17a0bf823462 | 245 | |
phonemacro | 12:17a0bf823462 | 246 | ibi_offset = rsp[ptr+52]; |
phonemacro | 12:17a0bf823462 | 247 | |
phonemacro | 12:17a0bf823462 | 248 | sptr += (TTL_SZ); |
phonemacro | 12:17a0bf823462 | 249 | #if 1 |
phonemacro | 12:17a0bf823462 | 250 | pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi); |
phonemacro | 12:17a0bf823462 | 251 | pc.printf("%d,%d,", ibi_conf, act); |
phonemacro | 12:17a0bf823462 | 252 | pc.printf("%d,%d,%d,", walk_stp, run_stp, energy); |
phonemacro | 12:17a0bf823462 | 253 | pc.printf("%d,%d,%d,%d,", amr, iadj1_rqt, iadj1, iadj2_rqt); |
phonemacro | 12:17a0bf823462 | 254 | pc.printf("%d,%d,%d,%d,", iadj2, iadj3_rqt, iadj3, intadj_rqt); |
phonemacro | 12:17a0bf823462 | 255 | pc.printf("%d,%d,%d,%d,", intadj, smpladj_rqt, smpladj, rqt_smplave); |
phonemacro | 12:17a0bf823462 | 256 | pc.printf("%d,%d,", afestatehr, hr_motion); |
phonemacro | 12:17a0bf823462 | 257 | pc.printf("%d,", scd); |
phonemacro | 12:17a0bf823462 | 258 | pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo); |
phonemacro | 12:17a0bf823462 | 259 | pc.printf("%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state); |
phonemacro | 12:17a0bf823462 | 260 | pc.printf("%d,", ibi_offset); |
phonemacro | 12:17a0bf823462 | 261 | #else |
phonemacro | 12:17a0bf823462 | 262 | pc.printf("%d,%d,", hr, hr_conf); |
phonemacro | 12:17a0bf823462 | 263 | pc.printf("%d,%d,", spo2, spo2_conf); |
phonemacro | 16:ff1122f0624a | 264 | pc.printf("%d,%d,%d,", spo2_lo, spo2_mo, spo2_lopi); |
phonemacro | 12:17a0bf823462 | 265 | pc.printf("%d,%d,", spo2_unrel, scd); |
phonemacro | 12:17a0bf823462 | 266 | #endif |
phonemacro | 12:17a0bf823462 | 267 | #else // normal algo size |
phonemacro | 12:17a0bf823462 | 268 | // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ); |
phonemacro | 12:17a0bf823462 | 269 | opmode = rsp[ptr]; |
phonemacro | 12:17a0bf823462 | 270 | hr = (rsp[ptr+1] << 8) + rsp[ptr+2]; |
phonemacro | 12:17a0bf823462 | 271 | hr_conf = rsp[ptr+3]; |
phonemacro | 12:17a0bf823462 | 272 | ibi = (rsp[ptr+4] << 8) + rsp[ptr+5]; |
phonemacro | 4:4f1e9439f048 | 273 | |
phonemacro | 11:a16b6bf38841 | 274 | ibi_conf = rsp[ptr+6]; |
phonemacro | 3:da975696b936 | 275 | act = rsp[ptr+7]; |
phonemacro | 3:da975696b936 | 276 | r = (rsp[ptr+8] << 8) + rsp[ptr+9]; |
phonemacro | 0:6f65cae31c54 | 277 | spo2_conf = rsp[ptr+10]; |
phonemacro | 4:4f1e9439f048 | 278 | |
phonemacro | 0:6f65cae31c54 | 279 | spo2 = (rsp[ptr+11] << 8) + rsp[ptr+12]; |
phonemacro | 4:4f1e9439f048 | 280 | spo2_compl = rsp[ptr+13]; |
phonemacro | 4:4f1e9439f048 | 281 | spo2_lo = rsp[ptr+14]; |
phonemacro | 4:4f1e9439f048 | 282 | spo2_mo = rsp[ptr+15]; |
phonemacro | 4:4f1e9439f048 | 283 | |
phonemacro | 4:4f1e9439f048 | 284 | spo2_lopi = rsp[ptr+16]; |
phonemacro | 4:4f1e9439f048 | 285 | spo2_unrel = rsp[ptr+17]; |
phonemacro | 4:4f1e9439f048 | 286 | spo2_state = rsp[ptr+18]; |
phonemacro | 2:563d90a111b3 | 287 | scd = rsp[ptr+19]; |
phonemacro | 0:6f65cae31c54 | 288 | |
phonemacro | 4:4f1e9439f048 | 289 | ibi_offset = rsp[ptr+20]; |
phonemacro | 0:6f65cae31c54 | 290 | |
phonemacro | 4:4f1e9439f048 | 291 | sptr += (TTL_SZ); |
phonemacro | 4:4f1e9439f048 | 292 | #if 0 |
phonemacro | 4:4f1e9439f048 | 293 | pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi); |
phonemacro | 4:4f1e9439f048 | 294 | pc.printf("%d,%d,%d,%d,", ibi_conf, act, r, spo2_conf); |
phonemacro | 4:4f1e9439f048 | 295 | pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo); |
phonemacro | 4:4f1e9439f048 | 296 | pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state, scd); |
phonemacro | 4:4f1e9439f048 | 297 | pc.printf("%d,", ibi_offset); |
phonemacro | 4:4f1e9439f048 | 298 | #else |
phonemacro | 4:4f1e9439f048 | 299 | pc.printf("%d,%d,", hr, hr_conf); |
phonemacro | 4:4f1e9439f048 | 300 | pc.printf("%d,%d,", spo2, spo2_conf); |
phonemacro | 4:4f1e9439f048 | 301 | pc.printf("%d,", spo2_lo); |
phonemacro | 4:4f1e9439f048 | 302 | pc.printf("%d,%d,", spo2_unrel, scd); |
phonemacro | 4:4f1e9439f048 | 303 | #endif |
phonemacro | 12:17a0bf823462 | 304 | #endif // end normal algo size |
phonemacro | 14:c8cc6d7fd5f9 | 305 | #endif // !RAW |
phonemacro | 4:4f1e9439f048 | 306 | |
phonemacro | 3:da975696b936 | 307 | pc.printf("\n\r"); |
phonemacro | 0:6f65cae31c54 | 308 | } |
phonemacro | 0:6f65cae31c54 | 309 | mfio = 1; |
phonemacro | 0:6f65cae31c54 | 310 | } |
phonemacro | 0:6f65cae31c54 | 311 | |
phonemacro | 6:e1b7190d6cb5 | 312 | #ifdef MAXREFDES103_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 313 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 314 | // init_max20303_pmic |
phonemacro | 14:c8cc6d7fd5f9 | 315 | /*****************************************************************************/ |
phonemacro | 6:e1b7190d6cb5 | 316 | void init_max20303_pmic(void) { |
phonemacro | 5:7f5a012747a5 | 317 | /* Wait for pmic to settle down */ |
phonemacro | 5:7f5a012747a5 | 318 | thread_sleep_for(800); |
phonemacro | 5:7f5a012747a5 | 319 | |
phonemacro | 5:7f5a012747a5 | 320 | //set_time(1544787300); // Set RTC time to Wed, 28 Oct 2009 11:35:37 |
phonemacro | 6:e1b7190d6cb5 | 321 | MAX20303 max20303(&sh_i2c); |
phonemacro | 5:7f5a012747a5 | 322 | /*Set LDO1 to 1.8v*/ |
phonemacro | 5:7f5a012747a5 | 323 | max20303.LDO1Config(); |
phonemacro | 5:7f5a012747a5 | 324 | |
phonemacro | 5:7f5a012747a5 | 325 | /*Set LDO2 to 3v*/ |
phonemacro | 5:7f5a012747a5 | 326 | max20303.LDO2Config(); |
phonemacro | 5:7f5a012747a5 | 327 | |
phonemacro | 5:7f5a012747a5 | 328 | //max20303.BoostEnable(); |
phonemacro | 5:7f5a012747a5 | 329 | max20303.BuckBoostEnable(); |
phonemacro | 5:7f5a012747a5 | 330 | |
phonemacro | 5:7f5a012747a5 | 331 | max20303.led0on(0); |
phonemacro | 5:7f5a012747a5 | 332 | max20303.led1on(0); |
phonemacro | 5:7f5a012747a5 | 333 | max20303.led2on(0); |
phonemacro | 5:7f5a012747a5 | 334 | |
phonemacro | 5:7f5a012747a5 | 335 | /* Wait for pmic to settle down */ |
phonemacro | 5:7f5a012747a5 | 336 | thread_sleep_for(200); |
phonemacro | 6:e1b7190d6cb5 | 337 | |
phonemacro | 5:7f5a012747a5 | 338 | } |
phonemacro | 6:e1b7190d6cb5 | 339 | #endif // MAXREFDES103_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 340 | |
phonemacro | 14:c8cc6d7fd5f9 | 341 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 342 | // init_sh_algo |
phonemacro | 14:c8cc6d7fd5f9 | 343 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 344 | void init_sh_algo(void) { |
phonemacro | 14:c8cc6d7fd5f9 | 345 | char cmd[8]; |
phonemacro | 0:6f65cae31c54 | 346 | char rsp[256]; |
phonemacro | 10:192ea88e964b | 347 | // switch to application mode |
phonemacro | 0:6f65cae31c54 | 348 | rst = 0; |
phonemacro | 0:6f65cae31c54 | 349 | mfio = 1; |
phonemacro | 0:6f65cae31c54 | 350 | thread_sleep_for(10); |
phonemacro | 0:6f65cae31c54 | 351 | rst = 1; |
phonemacro | 0:6f65cae31c54 | 352 | thread_sleep_for(1500); |
phonemacro | 10:192ea88e964b | 353 | #ifdef MAXREFDES103_CFG |
phonemacro | 10:192ea88e964b | 354 | init_max20303_pmic(); |
phonemacro | 10:192ea88e964b | 355 | #endif |
phonemacro | 0:6f65cae31c54 | 356 | |
phonemacro | 1:da792e46a385 | 357 | mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 358 | |
phonemacro | 4:4f1e9439f048 | 359 | //read operating mode |
phonemacro | 4:4f1e9439f048 | 360 | cmd[0] = 0x02; cmd[1] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 361 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 1:da792e46a385 | 362 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 363 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 6:e1b7190d6cb5 | 364 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 365 | pc.printf("\n\r 0x02 0x00 Status, Read Operating Mode: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 5:7f5a012747a5 | 366 | //1.11 rd ver |
phonemacro | 4:4f1e9439f048 | 367 | cmd[0] = 0xFF; cmd[1] = 0x03; |
phonemacro | 6:e1b7190d6cb5 | 368 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 1:da792e46a385 | 369 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 370 | sh_i2c.read(SH_ADDR, rsp, 4); |
phonemacro | 1:da792e46a385 | 371 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 372 | pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]); |
phonemacro | 0:6f65cae31c54 | 373 | |
phonemacro | 17:0d6e99a0fd8d | 374 | #if 0 |
phonemacro | 17:0d6e99a0fd8d | 375 | // algo sz |
phonemacro | 17:0d6e99a0fd8d | 376 | cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x01; |
phonemacro | 17:0d6e99a0fd8d | 377 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 17:0d6e99a0fd8d | 378 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 379 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 17:0d6e99a0fd8d | 380 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 381 | pc.printf("algo size: %d %d \n\r", rsp[0], rsp[1]); |
phonemacro | 17:0d6e99a0fd8d | 382 | |
phonemacro | 17:0d6e99a0fd8d | 383 | // algo sz |
phonemacro | 17:0d6e99a0fd8d | 384 | cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x02; |
phonemacro | 17:0d6e99a0fd8d | 385 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 17:0d6e99a0fd8d | 386 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 387 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 17:0d6e99a0fd8d | 388 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 389 | pc.printf("algo size: %d %d \n\r", rsp[0], rsp[1]); |
phonemacro | 17:0d6e99a0fd8d | 390 | |
phonemacro | 17:0d6e99a0fd8d | 391 | // algo sz |
phonemacro | 17:0d6e99a0fd8d | 392 | cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x03; |
phonemacro | 17:0d6e99a0fd8d | 393 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 17:0d6e99a0fd8d | 394 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 395 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 17:0d6e99a0fd8d | 396 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 17:0d6e99a0fd8d | 397 | pc.printf("algo size: %d %d \n\r", rsp[0], rsp[1]); |
phonemacro | 17:0d6e99a0fd8d | 398 | #endif |
phonemacro | 17:0d6e99a0fd8d | 399 | |
phonemacro | 17:0d6e99a0fd8d | 400 | #if 0 |
phonemacro | 17:0d6e99a0fd8d | 401 | // set Perfusion Index threshold to .05 (3x.13.19+) |
phonemacro | 17:0d6e99a0fd8d | 402 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x1D; cmd[3] = 50; |
phonemacro | 16:ff1122f0624a | 403 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 16:ff1122f0624a | 404 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 16:ff1122f0624a | 405 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 16:ff1122f0624a | 406 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 16:ff1122f0624a | 407 | pc.printf("pi set to 0x19 : %x \n\r", rsp[0]); |
phonemacro | 17:0d6e99a0fd8d | 408 | #endif |
phonemacro | 16:ff1122f0624a | 409 | |
phonemacro | 0:6f65cae31c54 | 410 | // 1.3 sensor and algo data |
phonemacro | 4:4f1e9439f048 | 411 | cmd[0] = 0x10; cmd[1] = 0x00; |
phonemacro | 2:563d90a111b3 | 412 | #ifdef ALGO_ONLY |
phonemacro | 0:6f65cae31c54 | 413 | cmd[2] = 0x02; // algo data |
phonemacro | 4:4f1e9439f048 | 414 | pc.printf("algo only \n\r"); |
phonemacro | 2:563d90a111b3 | 415 | #else |
phonemacro | 2:563d90a111b3 | 416 | cmd[2] = 0x03; // sensor + algo data |
phonemacro | 4:4f1e9439f048 | 417 | pc.printf("sens+algo \n\r"); |
phonemacro | 2:563d90a111b3 | 418 | #endif |
phonemacro | 6:e1b7190d6cb5 | 419 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 1:da792e46a385 | 420 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 421 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 422 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 423 | pc.printf("1.3 Status: %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 424 | // 1.7 cont hr, spo2 |
phonemacro | 4:4f1e9439f048 | 425 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0A; cmd[3] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 426 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 3:da975696b936 | 427 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 428 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 429 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 430 | pc.printf("1.7 Status: %x\n\r", rsp[0]); |
phonemacro | 4:4f1e9439f048 | 431 | // 1.8 AEC enable (default) |
phonemacro | 4:4f1e9439f048 | 432 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0B; cmd[3] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 433 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 1:da792e46a385 | 434 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 435 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 436 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 437 | pc.printf("1.8 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 438 | #if AGC |
phonemacro | 13:1baccc6275a7 | 439 | // AGC1.8 Disable auto PD (default |
phonemacro | 13:1baccc6275a7 | 440 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x00; |
phonemacro | 13:1baccc6275a7 | 441 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 13:1baccc6275a7 | 442 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 443 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 13:1baccc6275a7 | 444 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 445 | pc.printf("AGC1.8 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 446 | // AGC1.9 Disable SCD (default) |
phonemacro | 13:1baccc6275a7 | 447 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x00; |
phonemacro | 13:1baccc6275a7 | 448 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 13:1baccc6275a7 | 449 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 450 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 13:1baccc6275a7 | 451 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 452 | pc.printf("AGC1.9 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 453 | // AGC1.10 Set AGC target PD TO 10uA |
phonemacro | 13:1baccc6275a7 | 454 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x11; cmd[3] = 0x00; cmd[3] = 0x64; |
phonemacro | 13:1baccc6275a7 | 455 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 13:1baccc6275a7 | 456 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 457 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 13:1baccc6275a7 | 458 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 13:1baccc6275a7 | 459 | pc.printf("AGC1.10 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 460 | #else |
phonemacro | 4:4f1e9439f048 | 461 | // 1.9 auto PD (default |
phonemacro | 4:4f1e9439f048 | 462 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 463 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 1:da792e46a385 | 464 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 465 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 466 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 467 | pc.printf("1.9 Status: %x\n\r", rsp[0]); |
phonemacro | 4:4f1e9439f048 | 468 | // 1.10 SCD (default) |
phonemacro | 4:4f1e9439f048 | 469 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 470 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 4:4f1e9439f048 | 471 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 472 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 4:4f1e9439f048 | 473 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 474 | pc.printf("1.7 Status: %x\n\r", rsp[0]); |
phonemacro | 13:1baccc6275a7 | 475 | #endif |
phonemacro | 3:da975696b936 | 476 | #ifdef MAXM86146_CFG |
phonemacro | 3:da975696b936 | 477 | //1.20 Sec 4.1 map leds to slots for MAXM86146 |
phonemacro | 4:4f1e9439f048 | 478 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x13; cmd[4] = 0x56; cmd[5] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 479 | sh_i2c.write(SH_ADDR, cmd, 6); |
phonemacro | 3:da975696b936 | 480 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 481 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 482 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 483 | pc.printf("map leds to slots %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 484 | //1.21 map HR inputs to slots |
phonemacro | 4:4f1e9439f048 | 485 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x11; |
phonemacro | 6:e1b7190d6cb5 | 486 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 3:da975696b936 | 487 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 488 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 489 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 490 | pc.printf("map HR to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 491 | //1.22 map SpO2 inputs to slots |
phonemacro | 4:4f1e9439f048 | 492 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x30; cmd[4] = 0x20; |
phonemacro | 6:e1b7190d6cb5 | 493 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 3:da975696b936 | 494 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 495 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 496 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 497 | pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 498 | #if 0 |
phonemacro | 2:563d90a111b3 | 499 | //1.20 Sec 4.1 map leds to slots for MAXM86146 |
phonemacro | 4:4f1e9439f048 | 500 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x15; cmd[4] = 0x60; cmd[5] = 0x00; |
phonemacro | 6:e1b7190d6cb5 | 501 | sh_i2c.write(SH_ADDR, cmd, 6); |
phonemacro | 1:da792e46a385 | 502 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 503 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 504 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 505 | pc.printf("map leds to slots%x\n\r", rsp[0]); |
phonemacro | 2:563d90a111b3 | 506 | //1.21 map HR inputs to slots |
phonemacro | 4:4f1e9439f048 | 507 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x01; |
phonemacro | 6:e1b7190d6cb5 | 508 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 1:da792e46a385 | 509 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 510 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 511 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 512 | pc.printf("map HR to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 2:563d90a111b3 | 513 | //1.22 map SpO2 inputs to slots |
phonemacro | 4:4f1e9439f048 | 514 | cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x20; cmd[4] = 0x10; |
phonemacro | 6:e1b7190d6cb5 | 515 | sh_i2c.write(SH_ADDR, cmd, 5); |
phonemacro | 1:da792e46a385 | 516 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 517 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 1:da792e46a385 | 518 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 3:da975696b936 | 519 | pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]); |
phonemacro | 3:da975696b936 | 520 | #endif |
phonemacro | 3:da975696b936 | 521 | #endif // MAXM86146_CFG |
phonemacro | 0:6f65cae31c54 | 522 | |
phonemacro | 4:4f1e9439f048 | 523 | // 1.3 Enable HR, SpO2 algo |
phonemacro | 12:17a0bf823462 | 524 | #ifdef EXTENDED_ALGO |
phonemacro | 12:17a0bf823462 | 525 | cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x02; |
phonemacro | 12:17a0bf823462 | 526 | #else |
phonemacro | 4:4f1e9439f048 | 527 | cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x01; |
phonemacro | 12:17a0bf823462 | 528 | #endif |
phonemacro | 6:e1b7190d6cb5 | 529 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 0:6f65cae31c54 | 530 | thread_sleep_for(465); |
phonemacro | 6:e1b7190d6cb5 | 531 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 3:da975696b936 | 532 | pc.printf("1.14 status: %x\n\r", rsp[0]); |
phonemacro | 0:6f65cae31c54 | 533 | mfio = 1; |
phonemacro | 0:6f65cae31c54 | 534 | |
phonemacro | 4:4f1e9439f048 | 535 | #if 1 |
phonemacro | 4:4f1e9439f048 | 536 | //1.31 rd AFE part id |
phonemacro | 4:4f1e9439f048 | 537 | cmd[0] = 0x41; cmd[1] = 0x00; cmd[2] = 0xFF; |
phonemacro | 6:e1b7190d6cb5 | 538 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 4:4f1e9439f048 | 539 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 540 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 4:4f1e9439f048 | 541 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 542 | pc.printf("1.31 part id afe %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 4:4f1e9439f048 | 543 | //1.32 rd accel who |
phonemacro | 4:4f1e9439f048 | 544 | cmd[0] = 0x41; cmd[1] = 0x04; cmd[2] = 0x0F; |
phonemacro | 6:e1b7190d6cb5 | 545 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 4:4f1e9439f048 | 546 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 6:e1b7190d6cb5 | 547 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 4:4f1e9439f048 | 548 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 4:4f1e9439f048 | 549 | pc.printf("1.32 who accel %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 4:4f1e9439f048 | 550 | #endif |
phonemacro | 10:192ea88e964b | 551 | } |
phonemacro | 10:192ea88e964b | 552 | |
phonemacro | 14:c8cc6d7fd5f9 | 553 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 554 | // init_sh_raw |
phonemacro | 14:c8cc6d7fd5f9 | 555 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 556 | void init_sh_raw(void) { |
phonemacro | 14:c8cc6d7fd5f9 | 557 | char cmd[8]; |
phonemacro | 14:c8cc6d7fd5f9 | 558 | char rsp[256]; |
phonemacro | 14:c8cc6d7fd5f9 | 559 | // switch to application mode |
phonemacro | 14:c8cc6d7fd5f9 | 560 | rst = 0; |
phonemacro | 14:c8cc6d7fd5f9 | 561 | mfio = 1; |
phonemacro | 14:c8cc6d7fd5f9 | 562 | thread_sleep_for(10); |
phonemacro | 14:c8cc6d7fd5f9 | 563 | rst = 1; |
phonemacro | 14:c8cc6d7fd5f9 | 564 | thread_sleep_for(1500); |
phonemacro | 14:c8cc6d7fd5f9 | 565 | #ifdef MAXREFDES103_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 566 | init_max20303_pmic(); |
phonemacro | 14:c8cc6d7fd5f9 | 567 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 568 | |
phonemacro | 14:c8cc6d7fd5f9 | 569 | mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 570 | |
phonemacro | 14:c8cc6d7fd5f9 | 571 | //read operating mode |
phonemacro | 14:c8cc6d7fd5f9 | 572 | cmd[0] = 0x02; cmd[1] = 0x00; |
phonemacro | 14:c8cc6d7fd5f9 | 573 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 14:c8cc6d7fd5f9 | 574 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 575 | sh_i2c.read(SH_ADDR, rsp, 2); |
phonemacro | 14:c8cc6d7fd5f9 | 576 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 577 | pc.printf("\n\r 0x02 0x00 Status, Read Operating Mode: %x %x\n\r", rsp[0], rsp[1]); |
phonemacro | 14:c8cc6d7fd5f9 | 578 | //1.11 rd ver |
phonemacro | 14:c8cc6d7fd5f9 | 579 | cmd[0] = 0xFF; cmd[1] = 0x03; |
phonemacro | 14:c8cc6d7fd5f9 | 580 | sh_i2c.write(SH_ADDR, cmd, 2); |
phonemacro | 14:c8cc6d7fd5f9 | 581 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 582 | sh_i2c.read(SH_ADDR, rsp, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 583 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 584 | pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]); |
phonemacro | 14:c8cc6d7fd5f9 | 585 | |
phonemacro | 14:c8cc6d7fd5f9 | 586 | // raw1.1 sensor data |
phonemacro | 14:c8cc6d7fd5f9 | 587 | cmd[0] = 0x10; cmd[1] = 0x00; cmd[2] = 0x01; |
phonemacro | 14:c8cc6d7fd5f9 | 588 | pc.printf("raw sensor data only \n\r"); |
phonemacro | 14:c8cc6d7fd5f9 | 589 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 14:c8cc6d7fd5f9 | 590 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 591 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 592 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 593 | pc.printf("raw1.1 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 594 | // raw1.2 interrupt threshold |
phonemacro | 14:c8cc6d7fd5f9 | 595 | cmd[0] = 0x10; cmd[1] = 0x01; cmd[2] = 0x01; |
phonemacro | 14:c8cc6d7fd5f9 | 596 | sh_i2c.write(SH_ADDR, cmd, 3); |
phonemacro | 14:c8cc6d7fd5f9 | 597 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 598 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 599 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 600 | pc.printf("raw1.2 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 601 | // raw1.3 enable sh accel |
phonemacro | 14:c8cc6d7fd5f9 | 602 | cmd[0] = 0x44; cmd[1] = 0x04; cmd[2] = 0x01; cmd[3] = 0x00; |
phonemacro | 14:c8cc6d7fd5f9 | 603 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 604 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 605 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 606 | mfio = 1; thread_sleep_for(20); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 607 | pc.printf("raw1.3 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 608 | // raw1.4 enable AFE |
phonemacro | 14:c8cc6d7fd5f9 | 609 | cmd[0] = 0x44; cmd[1] = 0x00; cmd[2] = 0x01; cmd[3] = 0x00; |
phonemacro | 14:c8cc6d7fd5f9 | 610 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 611 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 612 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 613 | mfio = 1; thread_sleep_for(250); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 614 | pc.printf("raw1.4 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 615 | // raw1.5 sample rate 100 Hz, ave 1 |
phonemacro | 14:c8cc6d7fd5f9 | 616 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x18; // set AFE reg 0x12 to 100 Hz |
phonemacro | 14:c8cc6d7fd5f9 | 617 | // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x20; // set AFE reg 0x12 to 200 Hz |
phonemacro | 14:c8cc6d7fd5f9 | 618 | sh_i2c.write(SH_ADDR, cmd, 4); |
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, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 621 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 622 | pc.printf("raw1.5 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 623 | // raw1.6 LED1 current |
phonemacro | 14:c8cc6d7fd5f9 | 624 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 625 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 626 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 627 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 628 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 629 | pc.printf("raw1.6 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 630 | #ifndef MAXM86146_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 631 | // raw1.7 LED2 current |
phonemacro | 14:c8cc6d7fd5f9 | 632 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 633 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 634 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 635 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 636 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 637 | pc.printf("raw1.7 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 638 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 639 | // raw1.8 LED3 current |
phonemacro | 14:c8cc6d7fd5f9 | 640 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x7F; |
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; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 645 | pc.printf("raw1.8 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 646 | #ifdef MAXM86146_CFG |
phonemacro | 14:c8cc6d7fd5f9 | 647 | // LED5 current |
phonemacro | 14:c8cc6d7fd5f9 | 648 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x7F; |
phonemacro | 14:c8cc6d7fd5f9 | 649 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 650 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 651 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 652 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 653 | pc.printf("led5 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 654 | // LED6 current |
phonemacro | 14:c8cc6d7fd5f9 | 655 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x7F; |
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("led6 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 661 | |
phonemacro | 14:c8cc6d7fd5f9 | 662 | // Set Seq cntrl1 LED2, LED1 |
phonemacro | 14:c8cc6d7fd5f9 | 663 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x20; cmd[3] = 0x21; |
phonemacro | 14:c8cc6d7fd5f9 | 664 | sh_i2c.write(SH_ADDR, cmd, 4); |
phonemacro | 14:c8cc6d7fd5f9 | 665 | mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 666 | sh_i2c.read(SH_ADDR, rsp, 1); |
phonemacro | 14:c8cc6d7fd5f9 | 667 | mfio = 1; mfio = 0; wait_us(300); |
phonemacro | 14:c8cc6d7fd5f9 | 668 | pc.printf("Seq cntrl1 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 669 | // Set Seq cntrl2 LED4, LED3 |
phonemacro | 14:c8cc6d7fd5f9 | 670 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x21; cmd[3] = 0xA3; |
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("Seq cntrl2 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 676 | // Set Seq cntrl3 LED6, LED5 |
phonemacro | 14:c8cc6d7fd5f9 | 677 | cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x21; |
phonemacro | 14:c8cc6d7fd5f9 | 678 | // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x99; // Ambient |
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("Seq cntrl3 Status: %x\n\r", rsp[0]); |
phonemacro | 14:c8cc6d7fd5f9 | 684 | |
phonemacro | 14:c8cc6d7fd5f9 | 685 | #endif |
phonemacro | 14:c8cc6d7fd5f9 | 686 | } |
phonemacro | 14:c8cc6d7fd5f9 | 687 | |
phonemacro | 14:c8cc6d7fd5f9 | 688 | /*****************************************************************************/ |
phonemacro | 14:c8cc6d7fd5f9 | 689 | // main |
phonemacro | 14:c8cc6d7fd5f9 | 690 | /*****************************************************************************/ |
phonemacro | 10:192ea88e964b | 691 | int main() |
phonemacro | 10:192ea88e964b | 692 | { |
phonemacro | 10:192ea88e964b | 693 | sh_i2c.frequency(400000); |
phonemacro | 10:192ea88e964b | 694 | int32_t ledcnt = 0; |
phonemacro | 10:192ea88e964b | 695 | rLED = LED_OFF; gLED = LED_ON; bLED = LED_OFF; |
phonemacro | 10:192ea88e964b | 696 | Ticker ticker; // calls a callback repeatedly with a timeout |
phonemacro | 10:192ea88e964b | 697 | //ticker.attach(callback(&blink_timer), BLINKING_RATE_MS); /* set timer for one second */ |
phonemacro | 14:c8cc6d7fd5f9 | 698 | #ifdef RAW |
phonemacro | 14:c8cc6d7fd5f9 | 699 | init_sh_raw(); |
phonemacro | 14:c8cc6d7fd5f9 | 700 | #else |
phonemacro | 14:c8cc6d7fd5f9 | 701 | init_sh_algo(); |
phonemacro | 14:c8cc6d7fd5f9 | 702 | #endif |
phonemacro | 8:e6ae69cfecbf | 703 | #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG) || defined(MAXM86146_CFG) |
phonemacro | 6:e1b7190d6cb5 | 704 | Timer tmr1; |
phonemacro | 0:6f65cae31c54 | 705 | while (1) { |
phonemacro | 6:e1b7190d6cb5 | 706 | tmr1.start(); |
phonemacro | 6:e1b7190d6cb5 | 707 | if (tmr1.read_ms() > 40) { |
phonemacro | 7:23b067817ab8 | 708 | tmr1.reset(); |
phonemacro | 10:192ea88e964b | 709 | read_sh_fifo(); |
phonemacro | 7:23b067817ab8 | 710 | if ((ledcnt++ % 50) == 0) |
phonemacro | 6:e1b7190d6cb5 | 711 | gLED = !gLED; |
phonemacro | 0:6f65cae31c54 | 712 | } |
phonemacro | 0:6f65cae31c54 | 713 | } |
phonemacro | 6:e1b7190d6cb5 | 714 | #else |
phonemacro | 6:e1b7190d6cb5 | 715 | ticker.attach(callback(&fifo_timer), 0.040f); |
phonemacro | 6:e1b7190d6cb5 | 716 | while (1) { |
phonemacro | 6:e1b7190d6cb5 | 717 | if (Time_to_Read_PPG) { |
phonemacro | 10:192ea88e964b | 718 | read_sh_fifo(); |
phonemacro | 7:23b067817ab8 | 719 | if ((ledcnt++ % 50) == 0) |
phonemacro | 6:e1b7190d6cb5 | 720 | gLED = !gLED; |
phonemacro | 6:e1b7190d6cb5 | 721 | } |
phonemacro | 6:e1b7190d6cb5 | 722 | } |
phonemacro | 6:e1b7190d6cb5 | 723 | #endif |
phonemacro | 0:6f65cae31c54 | 724 | } |