Mode1 Optical Validation

Dependencies:   max32630fthr

Committer:
phonemacro
Date:
Wed Jun 01 18:42:12 2022 +0000
Revision:
66:d4989829a23d
Parent:
65:84513856f64e
updated xtalk

Who changed what in which revision?

UserRevisionLine numberNew contents of line
phonemacro 0:6f65cae31c54 1 /*******************************************************************************
phonemacro 30:77a30ea425da 2 * Copyright (C) 2021-22 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 62:21a7745d02e0 38 * https://os.mbed.com/users/phonemacro/code/MAX32664C_MAXM86146_Mode1_Optical
phonemacro 16:ff1122f0624a 39 * Tera Term output is set to 115200 baud rate.
phonemacro 60:fdccd048489b 40 * ver: 220531
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 61:a2e73c5b87e7 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 61:a2e73c5b87e7 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 50:dd2f60ab5686 87 // comment the two below if you want raw sensor+algo data
phonemacro 51:e2214db671c0 88 //#define ALGO_ONLY 1 // define this if you only want algo data
phonemacro 61:a2e73c5b87e7 89 #define RAW // define this if you want AFE+accel data, no algorithm, tested on 33.13.31
phonemacro 50:dd2f60ab5686 90 //#define RAW_HZ 25 // Raw data rate
phonemacro 55:04c9fad147d4 91 //#define RAW_HZ 50 // Raw data rate
phonemacro 55:04c9fad147d4 92 #define RAW_HZ 100 // Raw data rate
phonemacro 50:dd2f60ab5686 93 //#define RAW_HZ 200 // Raw data rate
phonemacro 50:dd2f60ab5686 94 //#define RAW_HZ 2004 // Raw data rate 200 Hz, ave 4
phonemacro 53:034f646141ae 95 //#define SPO2_CAL_RPT 1
phonemacro 66:d4989829a23d 96 #define MAXM86146_OPT_VALIDATION_GRN1 1 // Optical validatation
phonemacro 62:21a7745d02e0 97 //#define MAXM86146_OPT_VALIDATION_GRN2 1 // Optical validatation
phonemacro 62:21a7745d02e0 98 //#define MAXM86146_OPT_VALIDATION_RED 1 // Optical validatation
phonemacro 64:10da950111dd 99 //#define MAXM86146_OPT_VALIDATION_IR 1 // Optical validatation
phonemacro 66:d4989829a23d 100 //#define MAXM86146_OPT_VALIDATION_XTALK 1 // Optical validatation
phonemacro 33:c8fbd904df3e 101
phonemacro 33:c8fbd904df3e 102 // Comment out both of the below for Normal Algorithm Samples Format
phonemacro 61:a2e73c5b87e7 103 //#define EXTENDED_ALGO 1 // define this if you want the extended algo samples report format
phonemacro 35:67699bdae57e 104 //#define PACKED_NORMAL_ALGO 1 // define this if you want the packed normal algo samples report format, 33.13.31
phonemacro 45:d26b8bcce561 105 //#define PCK_CFG_MASK 1 // define this and the above if you want to config mask out some of the packed data, 33.13.31
phonemacro 13:1baccc6275a7 106 //#define AGC 1 // define this for AGC, otherwise the default is AEC
phonemacro 6:e1b7190d6cb5 107
phonemacro 61:a2e73c5b87e7 108 //#define USE_SYN 1
phonemacro 42:6f980909371f 109
phonemacro 42:6f980909371f 110 //#define REDUCE_RPT_PERIOD 0x19 // Report samples every 25 frame.
phonemacro 45:d26b8bcce561 111 //#define USE_FIFO_BUFFER_CNT 5 // Allow the FIFO to accumulate this many samples
phonemacro 42:6f980909371f 112
phonemacro 6:e1b7190d6cb5 113 #ifdef MAXREFDES103_CFG
phonemacro 5:7f5a012747a5 114 #include "MAX20303.h"
phonemacro 6:e1b7190d6cb5 115 I2C sh_i2c_pmic(P5_7, P6_0);
phonemacro 5:7f5a012747a5 116 #endif
phonemacro 5:7f5a012747a5 117
phonemacro 32:92adfbe18ab6 118 #ifdef MAXM86146_CFG
phonemacro 32:92adfbe18ab6 119 #define PPG_SZ 36 //maxm86146
phonemacro 32:92adfbe18ab6 120 #else
phonemacro 32:92adfbe18ab6 121 #define PPG_SZ 18 //maxm86161, max86141
phonemacro 32:92adfbe18ab6 122 #endif
phonemacro 32:92adfbe18ab6 123 #define ACCEL_SZ 6 // accel
phonemacro 32:92adfbe18ab6 124 #define SENSOR_SZ (PPG_SZ+ACCEL_SZ)
phonemacro 32:92adfbe18ab6 125
phonemacro 32:92adfbe18ab6 126 #if defined(MAXM86161_CFG) || defined(MAXM86146_CFG) // MAXM86161, MAXM86146, keep algo Fifo size as 52, 20 to keep compatible w/ the GUI
phonemacro 33:c8fbd904df3e 127 #define old_algo_sz 1 // 3x.12.0 or earlier; 32.9.x
phonemacro 28:315604f4b374 128 #endif
phonemacro 30:77a30ea425da 129
phonemacro 33:c8fbd904df3e 130 #ifdef old_algo_sz
phonemacro 18:f4c95b1c0efc 131 #ifdef EXTENDED_ALGO
phonemacro 33:c8fbd904df3e 132 #define ALGO_SZ 52 // 52 bytes, extended algo size for 3x.12.0
phonemacro 33:c8fbd904df3e 133 #elif defined(PACKED_NORMAL_ALGO)
phonemacro 33:c8fbd904df3e 134 #define ALGO_SZ 16 // 16 bytes, packed algo normal size for 33.31.31
phonemacro 18:f4c95b1c0efc 135 #else
phonemacro 42:6f980909371f 136 #define ALGO_SZ 20 // 20 bytes, normal algo size for 3x.12.0
phonemacro 18:f4c95b1c0efc 137 #endif
phonemacro 12:17a0bf823462 138 #else
phonemacro 18:f4c95b1c0efc 139 #ifdef EXTENDED_ALGO
phonemacro 33:c8fbd904df3e 140 #define ALGO_SZ 56 // 56 bytes, extended algo size for 3x.13.x+
phonemacro 18:f4c95b1c0efc 141 #else
phonemacro 33:c8fbd904df3e 142 #define ALGO_SZ 24 // 24 bytes, normal algo size for 3x.13.x+
phonemacro 18:f4c95b1c0efc 143 #endif
phonemacro 12:17a0bf823462 144 #endif
phonemacro 18:f4c95b1c0efc 145
phonemacro 61:a2e73c5b87e7 146 #ifdef ALGO_ONLY
phonemacro 61:a2e73c5b87e7 147 #define TTL_SZ (ALGO_SZ)
phonemacro 0:6f65cae31c54 148 #else
phonemacro 61:a2e73c5b87e7 149 #ifdef RAW
phonemacro 61:a2e73c5b87e7 150 #define TTL_SZ (PPG_SZ+ACCEL_SZ)
phonemacro 14:c8cc6d7fd5f9 151 #else
phonemacro 61:a2e73c5b87e7 152 #define TTL_SZ (PPG_SZ+ACCEL_SZ+ALGO_SZ)
phonemacro 14:c8cc6d7fd5f9 153 #endif
phonemacro 0:6f65cae31c54 154 #endif
phonemacro 0:6f65cae31c54 155
phonemacro 3:da975696b936 156 Serial pc(USBTX, USBRX, 115200);
phonemacro 0:6f65cae31c54 157 DigitalOut rLED(LED1);
phonemacro 0:6f65cae31c54 158 DigitalOut gLED(LED2);
phonemacro 0:6f65cae31c54 159 DigitalOut bLED(LED3);
phonemacro 6:e1b7190d6cb5 160
phonemacro 33:c8fbd904df3e 161 int32_t heading_printed; // has the heading been printed?
phonemacro 33:c8fbd904df3e 162
phonemacro 33:c8fbd904df3e 163
phonemacro 6:e1b7190d6cb5 164 //#define thread_sleep_for(x) wait_ms(x) // for older versions of mbed
phonemacro 0:6f65cae31c54 165
phonemacro 5:7f5a012747a5 166
phonemacro 6:e1b7190d6cb5 167 const int SH_ADDR = 0xAA;//0x55;
phonemacro 0:6f65cae31c54 168 int32_t Time_to_Read_PPG = 0;
phonemacro 0:6f65cae31c54 169
phonemacro 0:6f65cae31c54 170 #define BLINKING_RATE_MS 1000ms
phonemacro 0:6f65cae31c54 171 void blink_timer(void) {
phonemacro 0:6f65cae31c54 172 gLED = !gLED; /* blink the green LED */
phonemacro 0:6f65cae31c54 173 }
phonemacro 0:6f65cae31c54 174
phonemacro 0:6f65cae31c54 175 void fifo_timer(void) {
phonemacro 0:6f65cae31c54 176 Time_to_Read_PPG = 1;
phonemacro 0:6f65cae31c54 177 }
phonemacro 0:6f65cae31c54 178
phonemacro 14:c8cc6d7fd5f9 179 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 180 // read_sh_fifo
phonemacro 14:c8cc6d7fd5f9 181 /*****************************************************************************/
phonemacro 27:a45d6e38f2de 182 /*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*/
phonemacro 61:a2e73c5b87e7 183 #define OPTIMIZE_FIFO_READ 1 // Assume that the FIFO is filled at the specified rate, so just periodically check then number of samples in the FIFO to save power
phonemacro 27:a45d6e38f2de 184 #ifdef OPTIMIZE_FIFO_READ // tested on MAXM86146EVSYS
phonemacro 27:a45d6e38f2de 185 int32_t check_fifo_countdown;
phonemacro 42:6f980909371f 186 #define MAX_FIFO_CNT 20 // Only send the 0x00 0x00 (step 2.0), and 0x12 0x00 (step 2.1) commands every MAX_FIFO_CNT frames.
phonemacro 27:a45d6e38f2de 187 #endif
phonemacro 42:6f980909371f 188
phonemacro 10:192ea88e964b 189 void read_sh_fifo(void) {
phonemacro 33:c8fbd904df3e 190 char cmd[8], i, j, k, samples;
phonemacro 0:6f65cae31c54 191 char rsp[3000];
phonemacro 0:6f65cae31c54 192 int32_t ppg[12];
phonemacro 5:7f5a012747a5 193 int16_t accel[3];
phonemacro 33:c8fbd904df3e 194 int32_t tst[20];
phonemacro 12:17a0bf823462 195 int32_t status, opmode, hr, hr_conf, ibi, ibi_conf;
phonemacro 12:17a0bf823462 196 #ifdef EXTENDED_ALGO
phonemacro 12:17a0bf823462 197 int32_t walk_stp, run_stp, energy, amr, iadj1_rqt, iadj1, iadj2_rqt, iadj2, iadj3_rqt, iadj3;
phonemacro 12:17a0bf823462 198 int32_t intadj_rqt, intadj, smpladj_rqt, smpladj, rqt_smplave, afestatehr, hr_motion;
phonemacro 12:17a0bf823462 199 #endif
phonemacro 12:17a0bf823462 200 int32_t act, r, spo2, spo2_conf;
phonemacro 33:c8fbd904df3e 201 int32_t spo2_compl, spo2_lo, spo2_mo, spo2_lopi, spo2_unrel, spo2_state, ibi_offset, scd, inappro_ori;
phonemacro 0:6f65cae31c54 202 int32_t ptr = 0;
phonemacro 0:6f65cae31c54 203 int32_t sptr = 0;
phonemacro 1:da792e46a385 204 mfio = 0; wait_us(300);
phonemacro 0:6f65cae31c54 205 Time_to_Read_PPG = 0;
phonemacro 42:6f980909371f 206 samples = 1;
phonemacro 42:6f980909371f 207 #ifdef USE_FIFO_BUFFER_CNT
phonemacro 42:6f980909371f 208 samples = USE_FIFO_BUFFER_CNT;
phonemacro 42:6f980909371f 209 #endif
phonemacro 27:a45d6e38f2de 210 #if defined(OPTIMIZE_FIFO_READ)
phonemacro 27:a45d6e38f2de 211 check_fifo_countdown--;
phonemacro 27:a45d6e38f2de 212 if (check_fifo_countdown == 0) {
phonemacro 27:a45d6e38f2de 213 #endif
phonemacro 27:a45d6e38f2de 214
phonemacro 22:f6b366c3b954 215 #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG)
phonemacro 0:6f65cae31c54 216 // 2.1
phonemacro 27:a45d6e38f2de 217 cmd[0] = 0x00; cmd[1] = 0x00;
phonemacro 27:a45d6e38f2de 218 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 27:a45d6e38f2de 219 wait_us(100);
phonemacro 27:a45d6e38f2de 220 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 27:a45d6e38f2de 221 // pc.printf("2.1 Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 22:f6b366c3b954 222 #else
phonemacro 45:d26b8bcce561 223 // tested w/ 33.13.12 don't need 2.1
phonemacro 0:6f65cae31c54 224 #endif
phonemacro 0:6f65cae31c54 225 // 2.2
phonemacro 50:dd2f60ab5686 226 #if defined(PACKED_NORMAL_ALGO) || defined(USE_SYN)
phonemacro 61:a2e73c5b87e7 227 cmd[0] = 0x20;
phonemacro 35:67699bdae57e 228 sh_i2c.write(SH_ADDR, cmd, 1);
phonemacro 35:67699bdae57e 229 #else
phonemacro 27:a45d6e38f2de 230 cmd[0] = 0x12; cmd[1] = 0x00;
phonemacro 27:a45d6e38f2de 231 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 35:67699bdae57e 232 #endif
phonemacro 27:a45d6e38f2de 233 wait_us(100);
phonemacro 27:a45d6e38f2de 234 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 35:67699bdae57e 235 // mfio = 1; mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 236
phonemacro 27:a45d6e38f2de 237 // pc.printf("2.2 Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 27:a45d6e38f2de 238 samples = rsp[1];
phonemacro 27:a45d6e38f2de 239 // pc.printf("num samples %d, (num*ttl)+1 %d\n\r", rsp[1], TTL_SZ*samples+1);
phonemacro 27:a45d6e38f2de 240 // pc.printf("num smpls %d \n\r", samples);
phonemacro 27:a45d6e38f2de 241 #if defined(OPTIMIZE_FIFO_READ)
phonemacro 27:a45d6e38f2de 242 }
phonemacro 27:a45d6e38f2de 243 if (check_fifo_countdown <= 0)
phonemacro 27:a45d6e38f2de 244 check_fifo_countdown = MAX_FIFO_CNT;
phonemacro 27:a45d6e38f2de 245 #endif
phonemacro 27:a45d6e38f2de 246
phonemacro 0:6f65cae31c54 247 // 2.3
phonemacro 50:dd2f60ab5686 248 #if defined(PACKED_NORMAL_ALGO) || defined(USE_SYN)
phonemacro 35:67699bdae57e 249 cmd[0] = 0x21;;
phonemacro 35:67699bdae57e 250 sh_i2c.write(SH_ADDR, cmd, 1);
phonemacro 35:67699bdae57e 251 #else
phonemacro 45:d26b8bcce561 252 cmd[0] = 0x12; cmd[1] = 0x01;
phonemacro 45:d26b8bcce561 253 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 35:67699bdae57e 254 #endif
phonemacro 45:d26b8bcce561 255 wait_us(100);
phonemacro 45:d26b8bcce561 256 sh_i2c.read(SH_ADDR, rsp, 1+(TTL_SZ*samples));
phonemacro 42:6f980909371f 257 //pc.printf("num smpls %d ttlsiz %d\n\r", samples, TTL_SZ);
phonemacro 35:67699bdae57e 258 // mfio = 1; mfio = 0; wait_us(300);
phonemacro 45:d26b8bcce561 259 mfio = 1;
phonemacro 21:67d58af1ec56 260
phonemacro 0:6f65cae31c54 261 status = rsp[0];
phonemacro 5:7f5a012747a5 262
phonemacro 0:6f65cae31c54 263 sptr = 1;
phonemacro 42:6f980909371f 264 for (i = 0; i < samples; i++) {
phonemacro 0:6f65cae31c54 265 ptr = sptr;
phonemacro 35:67699bdae57e 266 #if !defined(ALGO_ONLY)
phonemacro 2:563d90a111b3 267 ppg[0] = (rsp[ptr+0] << 16) | (rsp[ptr+1] << 8) | (rsp[ptr+2]);
phonemacro 2:563d90a111b3 268 ppg[1] = (rsp[ptr+3] << 16) | (rsp[ptr+4] << 8) | (rsp[ptr+5]);
phonemacro 2:563d90a111b3 269 ppg[2] = (rsp[ptr+6] << 16) | (rsp[ptr+7] << 8) | (rsp[ptr+8]);
phonemacro 3:da975696b936 270 ppg[3] = (rsp[ptr+9] << 16) | (rsp[ptr+10] << 8) | (rsp[ptr+11]);
phonemacro 4:4f1e9439f048 271 ppg[4] = (rsp[ptr+12] << 16) | (rsp[ptr+13] << 8) | (rsp[ptr+14]);
phonemacro 4:4f1e9439f048 272 ppg[5] = (rsp[ptr+15] << 16) | (rsp[ptr+16] << 8) | (rsp[ptr+17]);
phonemacro 3:da975696b936 273 pc.printf("%d,%d,%d,%d,", ppg[0], ppg[1], ppg[2], ppg[3]);
phonemacro 47:346a13fbdc0f 274 #if defined(RAW) || defined(SPO2_CAL_RPT)
phonemacro 50:dd2f60ab5686 275 #if RAW_HZ <= 100
phonemacro 50:dd2f60ab5686 276 pc.printf("%d,%d,", ppg[4], ppg[5]);
phonemacro 50:dd2f60ab5686 277 #endif
phonemacro 61:a2e73c5b87e7 278 #endif
phonemacro 14:c8cc6d7fd5f9 279 #ifdef MAXM86146_CFG
phonemacro 47:346a13fbdc0f 280 #if defined(RAW) || defined(SPO2_CAL_RPT)
phonemacro 14:c8cc6d7fd5f9 281 ppg[6] = (rsp[ptr+18] << 16) | (rsp[ptr+19] << 8) | (rsp[ptr+20]);
phonemacro 14:c8cc6d7fd5f9 282 ppg[7] = (rsp[ptr+21] << 16) | (rsp[ptr+22] << 8) | (rsp[ptr+23]);
phonemacro 14:c8cc6d7fd5f9 283 ppg[8] = (rsp[ptr+24] << 16) | (rsp[ptr+25] << 8) | (rsp[ptr+26]);
phonemacro 14:c8cc6d7fd5f9 284 ppg[9] = (rsp[ptr+27] << 16) | (rsp[ptr+28] << 8) | (rsp[ptr+29]);
phonemacro 14:c8cc6d7fd5f9 285 ppg[10] = (rsp[ptr+30] << 16) | (rsp[ptr+31] << 8) | (rsp[ptr+32]);
phonemacro 14:c8cc6d7fd5f9 286 ppg[11] = (rsp[ptr+33] << 16) | (rsp[ptr+34] << 8) | (rsp[ptr+35]);
phonemacro 50:dd2f60ab5686 287 #if RAW_HZ <= 100
phonemacro 14:c8cc6d7fd5f9 288 pc.printf("%d,%d,%d,%d,%d,%d,", ppg[6], ppg[7],ppg[8], ppg[9],ppg[10], ppg[11]);
phonemacro 50:dd2f60ab5686 289 #endif
phonemacro 36:a6e7ff9c87a0 290 #endif // raw
phonemacro 36:a6e7ff9c87a0 291 #endif // MAXM86146_CFG
phonemacro 44:1b165a68474d 292 accel[0] = (rsp[1+PPG_SZ+0] << 8) | (rsp[1+PPG_SZ+1]);
phonemacro 44:1b165a68474d 293 accel[1] = (rsp[1+PPG_SZ+2] << 8) | (rsp[1+PPG_SZ+3]);
phonemacro 44:1b165a68474d 294 accel[2] = (rsp[1+PPG_SZ+4] << 8) | (rsp[1+PPG_SZ+5]);
phonemacro 5:7f5a012747a5 295 pc.printf("%d,%d,%d,", accel[0], accel[1], accel[2]);
phonemacro 5:7f5a012747a5 296
phonemacro 0:6f65cae31c54 297 ptr = sptr + SENSOR_SZ;
phonemacro 36:a6e7ff9c87a0 298
phonemacro 36:a6e7ff9c87a0 299 #endif //!defined(ALGO_ONLY)
phonemacro 29:a7dd81450b35 300
phonemacro 61:a2e73c5b87e7 301 #ifndef RAW
phonemacro 12:17a0bf823462 302 #ifdef EXTENDED_ALGO
phonemacro 45:d26b8bcce561 303 // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ);
phonemacro 0:6f65cae31c54 304 opmode = rsp[ptr];
phonemacro 0:6f65cae31c54 305 hr = (rsp[ptr+1] << 8) + rsp[ptr+2];
phonemacro 0:6f65cae31c54 306 hr_conf = rsp[ptr+3];
phonemacro 12:17a0bf823462 307 ibi = (rsp[ptr+4] << 8) + rsp[ptr+5];
phonemacro 12:17a0bf823462 308
phonemacro 12:17a0bf823462 309 ibi_conf = rsp[ptr+6];
phonemacro 12:17a0bf823462 310 act = rsp[ptr+7];
phonemacro 12:17a0bf823462 311 walk_stp = (rsp[ptr+8] << 24) + (rsp[ptr+9] << 16) + (rsp[ptr+10] << 8) + rsp[ptr+11];
phonemacro 12:17a0bf823462 312 run_stp = (rsp[ptr+12] << 24) + (rsp[ptr+13] << 16) + (rsp[ptr+14] << 8) + rsp[ptr+15];
phonemacro 12:17a0bf823462 313
phonemacro 12:17a0bf823462 314 energy = (rsp[ptr+16] << 24) + (rsp[ptr+17] << 16) + (rsp[ptr+18] << 8) + rsp[ptr+19];
phonemacro 12:17a0bf823462 315 amr = (rsp[ptr+20] << 24) + (rsp[ptr+21] << 16) + (rsp[ptr+22] << 8) + rsp[ptr+23];
phonemacro 12:17a0bf823462 316 iadj1_rqt = rsp[ptr+24];
phonemacro 12:17a0bf823462 317 iadj1 = (rsp[ptr+25] << 8) + rsp[ptr+26];
phonemacro 12:17a0bf823462 318
phonemacro 12:17a0bf823462 319 iadj2_rqt = rsp[ptr+27];
phonemacro 12:17a0bf823462 320 iadj2 = (rsp[ptr+28] << 8) + rsp[ptr+29];
phonemacro 12:17a0bf823462 321 iadj3_rqt = rsp[ptr+30];
phonemacro 12:17a0bf823462 322 iadj3 = (rsp[ptr+31] << 8) + rsp[ptr+32];
phonemacro 12:17a0bf823462 323
phonemacro 12:17a0bf823462 324 intadj_rqt = rsp[ptr+33];
phonemacro 12:17a0bf823462 325 intadj = rsp[ptr+34];
phonemacro 12:17a0bf823462 326 smpladj_rqt = rsp[ptr+35];
phonemacro 12:17a0bf823462 327 smpladj = rsp[ptr+36];
phonemacro 12:17a0bf823462 328
phonemacro 12:17a0bf823462 329 rqt_smplave = rsp[ptr+37];
phonemacro 12:17a0bf823462 330 afestatehr = rsp[ptr+38];
phonemacro 12:17a0bf823462 331 hr_motion = rsp[ptr+39];
phonemacro 12:17a0bf823462 332 scd = rsp[ptr+40];
phonemacro 12:17a0bf823462 333
phonemacro 12:17a0bf823462 334
phonemacro 12:17a0bf823462 335 r = (rsp[ptr+41] << 8) + rsp[ptr+42];
phonemacro 12:17a0bf823462 336 spo2_conf = rsp[ptr+43];
phonemacro 12:17a0bf823462 337
phonemacro 12:17a0bf823462 338 spo2 = (rsp[ptr+44] << 8) + rsp[ptr+45];
phonemacro 12:17a0bf823462 339 spo2_compl = rsp[ptr+46];
phonemacro 53:034f646141ae 340 spo2_lo = rsp[ptr+47]; // low quality
phonemacro 12:17a0bf823462 341 spo2_mo = rsp[ptr+48];
phonemacro 12:17a0bf823462 342
phonemacro 12:17a0bf823462 343 spo2_lopi = rsp[ptr+49];
phonemacro 12:17a0bf823462 344 spo2_unrel = rsp[ptr+50];
phonemacro 12:17a0bf823462 345 spo2_state = rsp[ptr+51];
phonemacro 12:17a0bf823462 346
phonemacro 12:17a0bf823462 347 ibi_offset = rsp[ptr+52];
phonemacro 12:17a0bf823462 348
phonemacro 12:17a0bf823462 349 sptr += (TTL_SZ);
phonemacro 36:a6e7ff9c87a0 350
phonemacro 12:17a0bf823462 351 #if 1
phonemacro 33:c8fbd904df3e 352 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 353 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 354 #if defined(ALGO_ONLY)
phonemacro 33:c8fbd904df3e 355 pc.printf("opmode,hr,hr_conf,ibi,ibi_conf,act,walk_stp,run_stp,energy,amr,");
phonemacro 33:c8fbd904df3e 356 pc.printf("iadj1_rqt,iadj1,iadj2_rqt,iadj2,iadj3_rqt,iadj3,intadj_rqt,intadj,");
phonemacro 33:c8fbd904df3e 357 pc.printf("smpladj_rqt,smpladj,rqt_smplave,afestatehr,hr_motion,scd,");
phonemacro 51:e2214db671c0 358 pc.printf("r,");
phonemacro 33:c8fbd904df3e 359 pc.printf("spo2,spo2_compl,spo2_lo,spo2_mo,spo2_lopi,spo2_unrel,spo2_state,ibi_offset,\n\r");
phonemacro 36:a6e7ff9c87a0 360 #endif
phonemacro 33:c8fbd904df3e 361 }
phonemacro 12:17a0bf823462 362 pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi);
phonemacro 12:17a0bf823462 363 pc.printf("%d,%d,", ibi_conf, act);
phonemacro 12:17a0bf823462 364 pc.printf("%d,%d,%d,", walk_stp, run_stp, energy);
phonemacro 12:17a0bf823462 365 pc.printf("%d,%d,%d,%d,", amr, iadj1_rqt, iadj1, iadj2_rqt);
phonemacro 12:17a0bf823462 366 pc.printf("%d,%d,%d,%d,", iadj2, iadj3_rqt, iadj3, intadj_rqt);
phonemacro 12:17a0bf823462 367 pc.printf("%d,%d,%d,%d,", intadj, smpladj_rqt, smpladj, rqt_smplave);
phonemacro 12:17a0bf823462 368 pc.printf("%d,%d,", afestatehr, hr_motion);
phonemacro 51:e2214db671c0 369 pc.printf("%d,%d", scd, r);
phonemacro 12:17a0bf823462 370 pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo);
phonemacro 12:17a0bf823462 371 pc.printf("%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state);
phonemacro 12:17a0bf823462 372 pc.printf("%d,", ibi_offset);
phonemacro 12:17a0bf823462 373 #else
phonemacro 33:c8fbd904df3e 374 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 375 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 376 #if defined(ALGO_ONLY)
phonemacro 53:034f646141ae 377 pc.printf("hr,r,hr_conf,spo2,spo2_conf,spo2_lo,spo2_unrel,spo2_state,scd,\n\r");
phonemacro 36:a6e7ff9c87a0 378 #endif
phonemacro 33:c8fbd904df3e 379 }
phonemacro 51:e2214db671c0 380 pc.printf("%d,%d,%d", hr, hr_conf, r);
phonemacro 12:17a0bf823462 381 pc.printf("%d,%d,", spo2, spo2_conf);
phonemacro 16:ff1122f0624a 382 pc.printf("%d,%d,%d,", spo2_lo, spo2_mo, spo2_lopi);
phonemacro 53:034f646141ae 383 pc.printf("%d,%d,%d,", spo2_unrel,spo2_state, scd);
phonemacro 36:a6e7ff9c87a0 384 #endif // if 1
phonemacro 33:c8fbd904df3e 385 #elif defined(PACKED_NORMAL_ALGO)
phonemacro 33:c8fbd904df3e 386 // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ);
phonemacro 35:67699bdae57e 387 opmode = rsp[ptr];
phonemacro 33:c8fbd904df3e 388 hr = (rsp[ptr+1] << 8) + rsp[ptr+2];
phonemacro 33:c8fbd904df3e 389 hr_conf = rsp[ptr+3];
phonemacro 33:c8fbd904df3e 390 ibi = (rsp[ptr+4] << 8) + rsp[ptr+5];
phonemacro 33:c8fbd904df3e 391
phonemacro 33:c8fbd904df3e 392 ibi_conf = rsp[ptr+6];
phonemacro 33:c8fbd904df3e 393 // act = rsp[ptr+7];
phonemacro 33:c8fbd904df3e 394 r = (rsp[ptr+7] << 8) + rsp[ptr+8];
phonemacro 33:c8fbd904df3e 395 spo2_conf = rsp[ptr+9];
phonemacro 33:c8fbd904df3e 396
phonemacro 33:c8fbd904df3e 397 spo2 = (rsp[ptr+10] << 8) + rsp[ptr+11];
phonemacro 33:c8fbd904df3e 398 spo2_compl = rsp[ptr+12];
phonemacro 33:c8fbd904df3e 399
phonemacro 33:c8fbd904df3e 400 spo2_lo = 0; spo2_mo = 0; spo2_lopi = 0; spo2_unrel = 0;
phonemacro 33:c8fbd904df3e 401
phonemacro 33:c8fbd904df3e 402 if (rsp[ptr+13] & 0x01)
phonemacro 33:c8fbd904df3e 403 spo2_lo = 1;
phonemacro 33:c8fbd904df3e 404 if (rsp[ptr+13] & 0x02)
phonemacro 33:c8fbd904df3e 405 spo2_mo = 1;
phonemacro 33:c8fbd904df3e 406 if (rsp[ptr+13] & 0x04)
phonemacro 33:c8fbd904df3e 407 spo2_lopi = 1;
phonemacro 33:c8fbd904df3e 408 if (rsp[ptr+13] & 0x08)
phonemacro 33:c8fbd904df3e 409 spo2_unrel = 1;
phonemacro 33:c8fbd904df3e 410 spo2_state = (0x30 & rsp[ptr+13]) >> 4;
phonemacro 33:c8fbd904df3e 411
phonemacro 33:c8fbd904df3e 412 scd = (0x03 & rsp[ptr+14]);
phonemacro 33:c8fbd904df3e 413 act = (0x1C & rsp[ptr+14]) >> 2;
phonemacro 33:c8fbd904df3e 414 inappro_ori = (0x20 & rsp[ptr+14]) >> 5;
phonemacro 33:c8fbd904df3e 415
phonemacro 33:c8fbd904df3e 416 ibi_offset = rsp[ptr+15];
phonemacro 33:c8fbd904df3e 417
phonemacro 33:c8fbd904df3e 418 sptr += (TTL_SZ);
phonemacro 37:249b548e6488 419 #if defined(PCK_CFG_MASK) // hex out, for printing config masked out packed data
phonemacro 35:67699bdae57e 420 // print as hex bytes
phonemacro 35:67699bdae57e 421 for (j=0; j<ALGO_SZ; j++)
phonemacro 35:67699bdae57e 422 pc.printf("%02X ", rsp[ptr+j]);
phonemacro 36:a6e7ff9c87a0 423 //pc.printf("\n\r" );
phonemacro 35:67699bdae57e 424 #endif
phonemacro 35:67699bdae57e 425
phonemacro 37:249b548e6488 426 #if !defined(PCK_CFG_MASK)
phonemacro 37:249b548e6488 427 #if 1
phonemacro 37:249b548e6488 428 #if 1 // print all
phonemacro 33:c8fbd904df3e 429 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 430 heading_printed = 1;
phonemacro 37:249b548e6488 431 #if defined(ALGO_ONLY)
phonemacro 33:c8fbd904df3e 432 pc.printf("opmode,hr,hr_conf,ibi,ibi_conf,act,r,spo2_conf,spo2,spo2_compl,spo2_lo,spo2_mo,spo2_lopi,spo2_unrel,spo2_state,scd,ibioffset,inappro_ori,\n\r");
phonemacro 37:249b548e6488 433 #endif
phonemacro 33:c8fbd904df3e 434 }
phonemacro 33:c8fbd904df3e 435 pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi);
phonemacro 33:c8fbd904df3e 436 pc.printf("%d,%d,%d,%d,", ibi_conf, act, r, spo2_conf);
phonemacro 33:c8fbd904df3e 437 pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo);
phonemacro 33:c8fbd904df3e 438 pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state, scd);
phonemacro 33:c8fbd904df3e 439 pc.printf("%d,", ibi_offset);
phonemacro 33:c8fbd904df3e 440 pc.printf("%d,", inappro_ori);
phonemacro 61:a2e73c5b87e7 441 #endif
phonemacro 37:249b548e6488 442 #else // print some
phonemacro 33:c8fbd904df3e 443 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 444 heading_printed = 1;
phonemacro 37:249b548e6488 445 #if defined(ALGO_ONLY)
phonemacro 54:2f19a5a83a62 446 pc.printf("hr,hr_conf,r,spo2,spo2_conf,spo2_lo,spo2_mo,spo2_lopi,spo2_unrel,spo2_state,scd,\n\r");
phonemacro 37:249b548e6488 447 #endif
phonemacro 33:c8fbd904df3e 448 }
phonemacro 51:e2214db671c0 449 pc.printf("%d,%d,%d", hr, hr_conf, r);
phonemacro 33:c8fbd904df3e 450 pc.printf("%d,%d,", spo2, spo2_conf);
phonemacro 54:2f19a5a83a62 451 pc.printf("%d,%d,", spo2_lo,spo2_mo);
phonemacro 53:034f646141ae 452 pc.printf("%d,%d,%d,%d", spo2_lopi,spo2_unrel, spo2_state, scd);
phonemacro 37:249b548e6488 453 #endif
phonemacro 37:249b548e6488 454 #endif // #if defined(PCK_CFG_MASK)
phonemacro 37:249b548e6488 455
phonemacro 12:17a0bf823462 456 #else // normal algo size
phonemacro 12:17a0bf823462 457 // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ);
phonemacro 12:17a0bf823462 458 opmode = rsp[ptr];
phonemacro 12:17a0bf823462 459 hr = (rsp[ptr+1] << 8) + rsp[ptr+2];
phonemacro 12:17a0bf823462 460 hr_conf = rsp[ptr+3];
phonemacro 12:17a0bf823462 461 ibi = (rsp[ptr+4] << 8) + rsp[ptr+5];
phonemacro 4:4f1e9439f048 462
phonemacro 11:a16b6bf38841 463 ibi_conf = rsp[ptr+6];
phonemacro 3:da975696b936 464 act = rsp[ptr+7];
phonemacro 3:da975696b936 465 r = (rsp[ptr+8] << 8) + rsp[ptr+9];
phonemacro 0:6f65cae31c54 466 spo2_conf = rsp[ptr+10];
phonemacro 4:4f1e9439f048 467
phonemacro 0:6f65cae31c54 468 spo2 = (rsp[ptr+11] << 8) + rsp[ptr+12];
phonemacro 4:4f1e9439f048 469 spo2_compl = rsp[ptr+13];
phonemacro 4:4f1e9439f048 470 spo2_lo = rsp[ptr+14];
phonemacro 4:4f1e9439f048 471 spo2_mo = rsp[ptr+15];
phonemacro 4:4f1e9439f048 472
phonemacro 4:4f1e9439f048 473 spo2_lopi = rsp[ptr+16];
phonemacro 4:4f1e9439f048 474 spo2_unrel = rsp[ptr+17];
phonemacro 4:4f1e9439f048 475 spo2_state = rsp[ptr+18];
phonemacro 2:563d90a111b3 476 scd = rsp[ptr+19];
phonemacro 0:6f65cae31c54 477
phonemacro 36:a6e7ff9c87a0 478 // ibi_offset = rsp[ptr+20];
phonemacro 0:6f65cae31c54 479
phonemacro 4:4f1e9439f048 480 sptr += (TTL_SZ);
phonemacro 61:a2e73c5b87e7 481
phonemacro 27:a45d6e38f2de 482 #if 0
phonemacro 33:c8fbd904df3e 483 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 484 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 485 #if defined(ALGO_ONLY)
phonemacro 33:c8fbd904df3e 486 pc.printf("opmode,hr,hr_conf,ibi,ibi_conf,act,r,spo2_conf,spo2,spo2_compl,spo2_lo,spo2_mo,spo2_lopi,spo2_unrel,spo2_state,scd,ibioffset,\n\r");
phonemacro 36:a6e7ff9c87a0 487 #endif
phonemacro 33:c8fbd904df3e 488 }
phonemacro 4:4f1e9439f048 489 pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi);
phonemacro 4:4f1e9439f048 490 pc.printf("%d,%d,%d,%d,", ibi_conf, act, r, spo2_conf);
phonemacro 4:4f1e9439f048 491 pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo);
phonemacro 4:4f1e9439f048 492 pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state, scd);
phonemacro 36:a6e7ff9c87a0 493 // pc.printf("%d,", ibi_offset);
phonemacro 4:4f1e9439f048 494 #else
phonemacro 33:c8fbd904df3e 495 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 496 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 497 #if defined(ALGO_ONLY)
phonemacro 54:2f19a5a83a62 498 pc.printf("hr,hr_conf,r,spo2,spo2_conf,spo2_lo,spo2_mo,spo2_lopi,spo2_unrel,spo2_state,scd,\n\r");
phonemacro 36:a6e7ff9c87a0 499 #endif
phonemacro 33:c8fbd904df3e 500 }
phonemacro 51:e2214db671c0 501 pc.printf("%d,%d,%d,", hr, hr_conf, r);
phonemacro 4:4f1e9439f048 502 pc.printf("%d,%d,", spo2, spo2_conf);
phonemacro 54:2f19a5a83a62 503 pc.printf("%d,%d,", spo2_lo,spo2_mo);
phonemacro 53:034f646141ae 504 pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel,spo2_state, scd);
phonemacro 4:4f1e9439f048 505 #endif
phonemacro 12:17a0bf823462 506 #endif // end normal algo size
phonemacro 61:a2e73c5b87e7 507 #endif // !RAW
phonemacro 4:4f1e9439f048 508
phonemacro 3:da975696b936 509 pc.printf("\n\r");
phonemacro 0:6f65cae31c54 510 }
phonemacro 0:6f65cae31c54 511 }
phonemacro 0:6f65cae31c54 512
phonemacro 6:e1b7190d6cb5 513 #ifdef MAXREFDES103_CFG
phonemacro 14:c8cc6d7fd5f9 514 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 515 // init_max20303_pmic
phonemacro 14:c8cc6d7fd5f9 516 /*****************************************************************************/
phonemacro 6:e1b7190d6cb5 517 void init_max20303_pmic(void) {
phonemacro 5:7f5a012747a5 518 /* Wait for pmic to settle down */
phonemacro 5:7f5a012747a5 519 thread_sleep_for(800);
phonemacro 5:7f5a012747a5 520
phonemacro 5:7f5a012747a5 521 //set_time(1544787300); // Set RTC time to Wed, 28 Oct 2009 11:35:37
phonemacro 6:e1b7190d6cb5 522 MAX20303 max20303(&sh_i2c);
phonemacro 5:7f5a012747a5 523 /*Set LDO1 to 1.8v*/
phonemacro 5:7f5a012747a5 524 max20303.LDO1Config();
phonemacro 5:7f5a012747a5 525
phonemacro 5:7f5a012747a5 526 /*Set LDO2 to 3v*/
phonemacro 5:7f5a012747a5 527 max20303.LDO2Config();
phonemacro 5:7f5a012747a5 528
phonemacro 5:7f5a012747a5 529 //max20303.BoostEnable();
phonemacro 5:7f5a012747a5 530 max20303.BuckBoostEnable();
phonemacro 5:7f5a012747a5 531
phonemacro 5:7f5a012747a5 532 max20303.led0on(0);
phonemacro 5:7f5a012747a5 533 max20303.led1on(0);
phonemacro 5:7f5a012747a5 534 max20303.led2on(0);
phonemacro 5:7f5a012747a5 535
phonemacro 5:7f5a012747a5 536 /* Wait for pmic to settle down */
phonemacro 5:7f5a012747a5 537 thread_sleep_for(200);
phonemacro 28:315604f4b374 538
phonemacro 5:7f5a012747a5 539 }
phonemacro 6:e1b7190d6cb5 540 #endif // MAXREFDES103_CFG
phonemacro 14:c8cc6d7fd5f9 541
phonemacro 61:a2e73c5b87e7 542 /*****************************************************************************/
phonemacro 61:a2e73c5b87e7 543 // init_sh_algo
phonemacro 61:a2e73c5b87e7 544 /*****************************************************************************/
phonemacro 61:a2e73c5b87e7 545 void init_sh_algo(void) {
phonemacro 61:a2e73c5b87e7 546 char cmd[64];
phonemacro 61:a2e73c5b87e7 547 char rsp[256];
phonemacro 61:a2e73c5b87e7 548
phonemacro 61:a2e73c5b87e7 549 #ifdef OPTIMIZE_FIFO_READ
phonemacro 61:a2e73c5b87e7 550 check_fifo_countdown = MAX_FIFO_CNT;
phonemacro 61:a2e73c5b87e7 551 #endif
phonemacro 61:a2e73c5b87e7 552
phonemacro 10:192ea88e964b 553 // switch to application mode
phonemacro 0:6f65cae31c54 554 rst = 0;
phonemacro 0:6f65cae31c54 555 mfio = 1;
phonemacro 0:6f65cae31c54 556 thread_sleep_for(10);
phonemacro 0:6f65cae31c54 557 rst = 1;
phonemacro 0:6f65cae31c54 558 thread_sleep_for(1500);
phonemacro 10:192ea88e964b 559 #ifdef MAXREFDES103_CFG
phonemacro 10:192ea88e964b 560 init_max20303_pmic();
phonemacro 10:192ea88e964b 561 #endif
phonemacro 47:346a13fbdc0f 562 // 33.13.31 needs at least 1.6s
phonemacro 47:346a13fbdc0f 563 // thread_sleep_for(100);
phonemacro 0:6f65cae31c54 564
phonemacro 1:da792e46a385 565 mfio = 0; wait_us(300);
phonemacro 42:6f980909371f 566 #ifdef REDUCE_RPT_PERIOD
phonemacro 42:6f980909371f 567 //Change report period to 25
phonemacro 61:a2e73c5b87e7 568 cmd[0] = 0x10; cmd[1] = 0x02; cmd[2] = REDUCE_RPT_PERIOD;
phonemacro 42:6f980909371f 569 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 42:6f980909371f 570 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 42:6f980909371f 571 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 42:6f980909371f 572 mfio = 1; mfio = 0; wait_us(300);
phonemacro 42:6f980909371f 573 pc.printf("Wr report period 25 %x\n\r", rsp[0]);
phonemacro 42:6f980909371f 574 #endif
phonemacro 48:6b93b56bb22e 575 //1.10 rd ver
phonemacro 4:4f1e9439f048 576 cmd[0] = 0xFF; cmd[1] = 0x03;
phonemacro 6:e1b7190d6cb5 577 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 1:da792e46a385 578 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 579 sh_i2c.read(SH_ADDR, rsp, 4);
phonemacro 1:da792e46a385 580 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 581 pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]);
phonemacro 0:6f65cae31c54 582
phonemacro 35:67699bdae57e 583 // wr config mask for packed normal data output fifo
phonemacro 37:249b548e6488 584 #if defined(PCK_CFG_MASK)
phonemacro 37:249b548e6488 585 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x20; cmd[3] = 0x7F; cmd[4] = 0xFF; cmd[5] = 0x00;
phonemacro 44:1b165a68474d 586 // cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x20; cmd[3] = 0xFF; cmd[4] = 0xFF; cmd[5] = 0x00;
phonemacro 35:67699bdae57e 587 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 35:67699bdae57e 588 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 589 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 35:67699bdae57e 590 mfio = 1; mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 591 pc.printf("wr config mask packed: %x \n\r", rsp[0]);
phonemacro 35:67699bdae57e 592 // rd config mask for packed normal data output fifo
phonemacro 35:67699bdae57e 593 cmd[0] = 0x51; cmd[1] = 0x07; cmd[2] = 0x20;
phonemacro 35:67699bdae57e 594 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 35:67699bdae57e 595 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 596 sh_i2c.read(SH_ADDR, rsp, 4);
phonemacro 35:67699bdae57e 597 mfio = 1; mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 598 pc.printf("rd config mask for packed normal data output fifo %d %X %X %X \n\r", rsp[0], rsp[1], rsp[2], rsp[3]);
phonemacro 44:1b165a68474d 599 #endif
phonemacro 35:67699bdae57e 600
phonemacro 33:c8fbd904df3e 601 #if defined(MAXM86161_CFG) || defined(MAXM86146_CFG)
phonemacro 33:c8fbd904df3e 602 // rd algo sz normal
phonemacro 17:0d6e99a0fd8d 603 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x01;
phonemacro 17:0d6e99a0fd8d 604 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 17:0d6e99a0fd8d 605 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 17:0d6e99a0fd8d 606 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 17:0d6e99a0fd8d 607 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 608 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 33:c8fbd904df3e 609 // rd algo sz extended
phonemacro 17:0d6e99a0fd8d 610 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x02;
phonemacro 17:0d6e99a0fd8d 611 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 17:0d6e99a0fd8d 612 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 17:0d6e99a0fd8d 613 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 17:0d6e99a0fd8d 614 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 615 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 33:c8fbd904df3e 616 // rd algo sz scd
phonemacro 17:0d6e99a0fd8d 617 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x03;
phonemacro 17:0d6e99a0fd8d 618 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 17:0d6e99a0fd8d 619 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 17:0d6e99a0fd8d 620 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 17:0d6e99a0fd8d 621 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 622 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 45:d26b8bcce561 623 #if defined(PACKED_NORMAL_ALGO) && (defined(MAXM86161_CFG) || defined(MAXM86146_CFG))
phonemacro 35:67699bdae57e 624 // rd algo sz packed normal
phonemacro 33:c8fbd904df3e 625 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x04;
phonemacro 33:c8fbd904df3e 626 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 33:c8fbd904df3e 627 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 628 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 33:c8fbd904df3e 629 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 630 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 33:c8fbd904df3e 631 #endif
phonemacro 17:0d6e99a0fd8d 632 #endif
phonemacro 17:0d6e99a0fd8d 633
phonemacro 17:0d6e99a0fd8d 634 #if 0
phonemacro 17:0d6e99a0fd8d 635 // set Perfusion Index threshold to .05 (3x.13.19+)
phonemacro 17:0d6e99a0fd8d 636 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x1D; cmd[3] = 50;
phonemacro 16:ff1122f0624a 637 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 16:ff1122f0624a 638 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 16:ff1122f0624a 639 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 16:ff1122f0624a 640 mfio = 1; mfio = 0; wait_us(300);
phonemacro 16:ff1122f0624a 641 pc.printf("pi set to 0x19 : %x \n\r", rsp[0]);
phonemacro 17:0d6e99a0fd8d 642 #endif
phonemacro 16:ff1122f0624a 643
phonemacro 48:6b93b56bb22e 644 // 1.1 sensor and algo data
phonemacro 4:4f1e9439f048 645 cmd[0] = 0x10; cmd[1] = 0x00;
phonemacro 2:563d90a111b3 646 #ifdef ALGO_ONLY
phonemacro 0:6f65cae31c54 647 cmd[2] = 0x02; // algo data
phonemacro 4:4f1e9439f048 648 pc.printf("algo only \n\r");
phonemacro 2:563d90a111b3 649 #else
phonemacro 2:563d90a111b3 650 cmd[2] = 0x03; // sensor + algo data
phonemacro 4:4f1e9439f048 651 pc.printf("sens+algo \n\r");
phonemacro 2:563d90a111b3 652 #endif
phonemacro 6:e1b7190d6cb5 653 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 1:da792e46a385 654 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 655 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 656 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 657 pc.printf("1.2 Status: %x\n\r", rsp[0]);
phonemacro 52:e5aba237e804 658 // 1.4 Continuous HR, Spo2
phonemacro 52:e5aba237e804 659 #ifndef SPO2_CAL_RPT
phonemacro 32:92adfbe18ab6 660 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0A; cmd[3] = 0x00;
phonemacro 32:92adfbe18ab6 661 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 32:92adfbe18ab6 662 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 663 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 32:92adfbe18ab6 664 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 665 pc.printf("1.5 Status: %x\n\r", rsp[0]);
phonemacro 52:e5aba237e804 666 #endif
phonemacro 48:6b93b56bb22e 667 // 1.5 AEC enable (default)
phonemacro 4:4f1e9439f048 668 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0B; cmd[3] = 0x01;
phonemacro 6:e1b7190d6cb5 669 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 1:da792e46a385 670 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 671 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 672 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 673 pc.printf("1.6 Status: %x\n\r", rsp[0]);
phonemacro 13:1baccc6275a7 674 #if AGC
phonemacro 48:6b93b56bb22e 675 // AGC 1.6 Disable auto PD (default
phonemacro 13:1baccc6275a7 676 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x00;
phonemacro 13:1baccc6275a7 677 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 13:1baccc6275a7 678 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 13:1baccc6275a7 679 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 13:1baccc6275a7 680 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 681 pc.printf("AGC1.7 Status: %x\n\r", rsp[0]);
phonemacro 48:6b93b56bb22e 682 // AGC 1.7 Disable SCD (default)
phonemacro 13:1baccc6275a7 683 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x00;
phonemacro 13:1baccc6275a7 684 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 13:1baccc6275a7 685 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 13:1baccc6275a7 686 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 13:1baccc6275a7 687 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 688 pc.printf("AGC1.8 Status: %x\n\r", rsp[0]);
phonemacro 48:6b93b56bb22e 689 // AGC 1.8 Set AGC target PD TO 10uA
phonemacro 13:1baccc6275a7 690 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x11; cmd[3] = 0x00; cmd[3] = 0x64;
phonemacro 13:1baccc6275a7 691 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 13:1baccc6275a7 692 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 13:1baccc6275a7 693 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 13:1baccc6275a7 694 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 695 pc.printf("AGC1.9 Status: %x\n\r", rsp[0]);
phonemacro 13:1baccc6275a7 696 #else
phonemacro 48:6b93b56bb22e 697 // 1.6 enable auto PD (default)
phonemacro 4:4f1e9439f048 698 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x01;
phonemacro 6:e1b7190d6cb5 699 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 1:da792e46a385 700 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 701 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 702 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 703 pc.printf("1.7 Status: %x\n\r", rsp[0]);
phonemacro 48:6b93b56bb22e 704 // 1.7 SCD (default)
phonemacro 4:4f1e9439f048 705 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x01;
phonemacro 6:e1b7190d6cb5 706 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 4:4f1e9439f048 707 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 708 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 4:4f1e9439f048 709 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 710 pc.printf("1.8 Status: %x\n\r", rsp[0]);
phonemacro 13:1baccc6275a7 711 #endif
phonemacro 28:315604f4b374 712
phonemacro 28:315604f4b374 713 #if defined(MAXM86161_CFG) //only use Red and IR
phonemacro 61:a2e73c5b87e7 714 //1.20 map leds to slots
phonemacro 28:315604f4b374 715 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x23; cmd[4] = 0x00; cmd[5] = 0x00;
phonemacro 28:315604f4b374 716 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 28:315604f4b374 717 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 718 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 719 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 720 pc.printf("map leds to slots %x\n\r", rsp[0]);
phonemacro 30:77a30ea425da 721 //1.21 map HR inputs to slots, default is 0x0073 for MAXM86161
phonemacro 30:77a30ea425da 722 #if 0 // NA for MAXM86161
phonemacro 28:315604f4b374 723 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x73;
phonemacro 28:315604f4b374 724 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 28:315604f4b374 725 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 726 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 727 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 728 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 30:77a30ea425da 729 #endif
phonemacro 28:315604f4b374 730 //1.22 map SpO2 inputs to slots
phonemacro 28:315604f4b374 731 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x00; cmd[4] = 0x10;
phonemacro 28:315604f4b374 732 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 28:315604f4b374 733 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 734 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 735 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 736 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 737 #endif
phonemacro 28:315604f4b374 738
phonemacro 3:da975696b936 739 #ifdef MAXM86146_CFG
phonemacro 32:92adfbe18ab6 740 //1.20 map leds to slots for MAXM86146
phonemacro 4:4f1e9439f048 741 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x13; cmd[4] = 0x56; cmd[5] = 0x00;
phonemacro 6:e1b7190d6cb5 742 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 3:da975696b936 743 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 744 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 745 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 746 pc.printf("map leds to slots %x\n\r", rsp[0]);
phonemacro 3:da975696b936 747 //1.21 map HR inputs to slots
phonemacro 4:4f1e9439f048 748 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x11;
phonemacro 6:e1b7190d6cb5 749 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 3:da975696b936 750 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 751 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 752 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 753 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 3:da975696b936 754 //1.22 map SpO2 inputs to slots
phonemacro 4:4f1e9439f048 755 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x30; cmd[4] = 0x20;
phonemacro 6:e1b7190d6cb5 756 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 3:da975696b936 757 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 758 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 759 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 760 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 26:33c0d3fd2a95 761
phonemacro 3:da975696b936 762 #if 0
phonemacro 2:563d90a111b3 763 //1.20 Sec 4.1 map leds to slots for MAXM86146
phonemacro 4:4f1e9439f048 764 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x15; cmd[4] = 0x60; cmd[5] = 0x00;
phonemacro 6:e1b7190d6cb5 765 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 1:da792e46a385 766 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 767 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 768 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 769 pc.printf("map leds to slots%x\n\r", rsp[0]);
phonemacro 2:563d90a111b3 770 //1.21 map HR inputs to slots
phonemacro 4:4f1e9439f048 771 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x01;
phonemacro 6:e1b7190d6cb5 772 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 1:da792e46a385 773 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 774 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 775 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 776 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 2:563d90a111b3 777 //1.22 map SpO2 inputs to slots
phonemacro 4:4f1e9439f048 778 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x20; cmd[4] = 0x10;
phonemacro 6:e1b7190d6cb5 779 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 1:da792e46a385 780 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 781 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 782 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 783 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 3:da975696b936 784 #endif
phonemacro 3:da975696b936 785 #endif // MAXM86146_CFG
phonemacro 0:6f65cae31c54 786
phonemacro 28:315604f4b374 787 #if 0 // MAXM86161 test new commands
phonemacro 28:315604f4b374 788 // LDO enable
phonemacro 28:315604f4b374 789 cmd[0] = 0x10; cmd[1] = 0x12; cmd[2] = 0x01;
phonemacro 28:315604f4b374 790 //cmd[0] = 0x10; cmd[1] = 0x12; cmd[2] = 0x00;
phonemacro 28:315604f4b374 791 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 792 thread_sleep_for(2);
phonemacro 28:315604f4b374 793 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 794 pc.printf("\n\r ldo en %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 795 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 796 // GPIO enable
phonemacro 28:315604f4b374 797 cmd[0] = 0x10; cmd[1] = 0x13; cmd[2] = 0x01;
phonemacro 28:315604f4b374 798 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 799 thread_sleep_for(2);
phonemacro 28:315604f4b374 800 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 801 pc.printf("\n\r gpio en %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 802 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 803 #endif
phonemacro 47:346a13fbdc0f 804 #if 0
phonemacro 47:346a13fbdc0f 805 //write SpO2 coefficients 0x00000000 FFD7FBDD 00AB61FE
phonemacro 61:a2e73c5b87e7 806 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x00;
phonemacro 47:346a13fbdc0f 807 cmd[3] = 0x00; cmd[4] = 0x00; cmd[5] = 0x00; cmd[6] = 0x00;
phonemacro 47:346a13fbdc0f 808 cmd[7] = 0xFF; cmd[8] = 0xD7; cmd[9] = 0xFB; cmd[10] = 0xDD;
phonemacro 47:346a13fbdc0f 809 cmd[11] = 0x00; cmd[12] = 0xAB; cmd[13] = 0x61; cmd[14] = 0xFE;
phonemacro 47:346a13fbdc0f 810 sh_i2c.write(SH_ADDR, cmd, 15);
phonemacro 47:346a13fbdc0f 811 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 812 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 47:346a13fbdc0f 813 mfio = 1; mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 814 pc.printf("Wr Spo2 Coeff %x\n\r", rsp[0]);
phonemacro 47:346a13fbdc0f 815 #endif
phonemacro 61:a2e73c5b87e7 816 //1.26 rd SpO2 Coefficients
phonemacro 47:346a13fbdc0f 817 cmd[0] = 0x51; cmd[1] = 0x07; cmd[2] = 0x00;
phonemacro 47:346a13fbdc0f 818 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 47:346a13fbdc0f 819 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 820 sh_i2c.read(SH_ADDR, rsp, 13);
phonemacro 47:346a13fbdc0f 821 mfio = 1; mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 822 pc.printf("%x SpO2 Coeff %2X%2X%2X%2X %2X%2X%2X%2X %2X%2X%2X%2X\n\r", rsp[0], rsp[1], rsp[2], rsp[3], rsp[4], rsp[5], rsp[6], rsp[7], rsp[8], rsp[9], rsp[10], rsp[11], rsp[12]);
phonemacro 28:315604f4b374 823
phonemacro 32:92adfbe18ab6 824 // 1.30 Enable HR, SpO2 algo
phonemacro 12:17a0bf823462 825 #ifdef EXTENDED_ALGO
phonemacro 12:17a0bf823462 826 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x02;
phonemacro 33:c8fbd904df3e 827 #elif defined(PACKED_NORMAL_ALGO)
phonemacro 33:c8fbd904df3e 828 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x04;
phonemacro 12:17a0bf823462 829 #else
phonemacro 4:4f1e9439f048 830 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x01;
phonemacro 12:17a0bf823462 831 #endif
phonemacro 6:e1b7190d6cb5 832 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 833 mfio = 1;
phonemacro 0:6f65cae31c54 834 thread_sleep_for(465);
phonemacro 28:315604f4b374 835 mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 836 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 837 pc.printf("1.14 status: %x\n\r", rsp[0]);
phonemacro 0:6f65cae31c54 838
phonemacro 4:4f1e9439f048 839 #if 1
phonemacro 4:4f1e9439f048 840 //1.31 rd AFE part id
phonemacro 4:4f1e9439f048 841 cmd[0] = 0x41; cmd[1] = 0x00; cmd[2] = 0xFF;
phonemacro 6:e1b7190d6cb5 842 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 4:4f1e9439f048 843 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 844 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 4:4f1e9439f048 845 mfio = 1; mfio = 0; wait_us(300);
phonemacro 4:4f1e9439f048 846 pc.printf("1.31 part id afe %x %x\n\r", rsp[0], rsp[1]);
phonemacro 4:4f1e9439f048 847 //1.32 rd accel who
phonemacro 4:4f1e9439f048 848 cmd[0] = 0x41; cmd[1] = 0x04; cmd[2] = 0x0F;
phonemacro 6:e1b7190d6cb5 849 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 4:4f1e9439f048 850 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 851 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 4:4f1e9439f048 852 mfio = 1; mfio = 0; wait_us(300);
phonemacro 4:4f1e9439f048 853 pc.printf("1.32 who accel %x %x\n\r", rsp[0], rsp[1]);
phonemacro 28:315604f4b374 854 #endif
phonemacro 52:e5aba237e804 855 // 1.35 spo2 calibration report for data collection
phonemacro 52:e5aba237e804 856 #ifdef SPO2_CAL_RPT
phonemacro 52:e5aba237e804 857 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0A; cmd[3] = 0x06;
phonemacro 52:e5aba237e804 858 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 52:e5aba237e804 859 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 860 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 52:e5aba237e804 861 mfio = 1; mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 862 pc.printf("1.5 Status: %x\n\r", rsp[0]);
phonemacro 52:e5aba237e804 863 #endif
phonemacro 52:e5aba237e804 864 // rd algo mode
phonemacro 52:e5aba237e804 865 cmd[0] = 0x51; cmd[1] = 0x07; cmd[2] = 0x0A;
phonemacro 52:e5aba237e804 866 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 52:e5aba237e804 867 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 868 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 52:e5aba237e804 869 mfio = 1; mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 870 pc.printf("algo mode %x %x\n\r", rsp[0], rsp[1]);
phonemacro 52:e5aba237e804 871
phonemacro 26:33c0d3fd2a95 872 mfio = 1;
phonemacro 10:192ea88e964b 873 }
phonemacro 10:192ea88e964b 874
phonemacro 61:a2e73c5b87e7 875
phonemacro 61:a2e73c5b87e7 876 void set_reg_opt_validation(void) {
phonemacro 61:a2e73c5b87e7 877 char cmd[16];
phonemacro 61:a2e73c5b87e7 878 char rsp[32];
phonemacro 61:a2e73c5b87e7 879
phonemacro 61:a2e73c5b87e7 880 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x09; cmd[3] = 0x7D; // fifo_a_full
phonemacro 61:a2e73c5b87e7 881 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 882 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 883 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 884 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 885 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 886
phonemacro 61:a2e73c5b87e7 887 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x11; cmd[3] = 0x3F; // ppg2_adc_rge=32768 ppg1_adc_rge=32768 tint=117.3us
phonemacro 61:a2e73c5b87e7 888 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 889 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 890 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 891 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 892 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 893
phonemacro 61:a2e73c5b87e7 894 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x13; cmd[3] = 0xC0; // reg ppg config 3
phonemacro 61:a2e73c5b87e7 895 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 896 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 897 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 898 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 899 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 900
phonemacro 61:a2e73c5b87e7 901 #if 0
phonemacro 61:a2e73c5b87e7 902 // set seq1 reg
phonemacro 61:a2e73c5b87e7 903 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x20; cmd[3] = 0x21;
phonemacro 61:a2e73c5b87e7 904 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 905 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 906 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 907 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 908 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 909
phonemacro 61:a2e73c5b87e7 910 // set seq2 reg
phonemacro 61:a2e73c5b87e7 911 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x21; cmd[3] = 0x43;
phonemacro 61:a2e73c5b87e7 912 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 913 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 914 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 915 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 916 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 917 // always set seq3 reg to none
phonemacro 61:a2e73c5b87e7 918 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x00;
phonemacro 61:a2e73c5b87e7 919 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 920 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 921 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 922 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 923 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 924 #endif
phonemacro 61:a2e73c5b87e7 925
phonemacro 61:a2e73c5b87e7 926 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x09; cmd[3] = 0x7D;
phonemacro 61:a2e73c5b87e7 927 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 928 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 929 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 930 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 931 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 932
phonemacro 62:21a7745d02e0 933 #if defined(MAXM86146_OPT_VALIDATION_GRN1)
phonemacro 61:a2e73c5b87e7 934 // Set Green1 current to 1uA, 10uA or 30uA
phonemacro 62:21a7745d02e0 935 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x29;
phonemacro 61:a2e73c5b87e7 936 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 937 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 938 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 939 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 940 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 941
phonemacro 61:a2e73c5b87e7 942 // Set LED2 current
phonemacro 61:a2e73c5b87e7 943 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x0;
phonemacro 61:a2e73c5b87e7 944 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 945 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 946 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 947 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 948 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 949
phonemacro 61:a2e73c5b87e7 950 // Set Green2 current
phonemacro 61:a2e73c5b87e7 951 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x0;
phonemacro 61:a2e73c5b87e7 952 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 953 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 954 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 955 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 956 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 957
phonemacro 61:a2e73c5b87e7 958 // Set LED4 current
phonemacro 61:a2e73c5b87e7 959 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x0;
phonemacro 61:a2e73c5b87e7 960 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 961 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 962 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 963 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 964 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 965
phonemacro 61:a2e73c5b87e7 966 // Set Red current
phonemacro 61:a2e73c5b87e7 967 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x0;
phonemacro 61:a2e73c5b87e7 968 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 969 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 970 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 971 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 972 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 973
phonemacro 61:a2e73c5b87e7 974 // Set IR current
phonemacro 61:a2e73c5b87e7 975 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0x0;
phonemacro 61:a2e73c5b87e7 976 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 977 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 978 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 979 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 980 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 981 #endif
phonemacro 62:21a7745d02e0 982 #if defined(MAXM86146_OPT_VALIDATION_GRN2)
phonemacro 63:61f62564922c 983 // Set Green1 current
phonemacro 62:21a7745d02e0 984 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x00;
phonemacro 62:21a7745d02e0 985 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 62:21a7745d02e0 986 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 987 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 62:21a7745d02e0 988 mfio = 1; mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 989 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 62:21a7745d02e0 990
phonemacro 62:21a7745d02e0 991 // Set LED2 current
phonemacro 62:21a7745d02e0 992 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x0;
phonemacro 62:21a7745d02e0 993 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 62:21a7745d02e0 994 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 995 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 62:21a7745d02e0 996 mfio = 1; mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 997 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 62:21a7745d02e0 998
phonemacro 63:61f62564922c 999 // Set Green2 current to 1uA, 10uA or 30uA
phonemacro 63:61f62564922c 1000 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x29;
phonemacro 62:21a7745d02e0 1001 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 62:21a7745d02e0 1002 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1003 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 62:21a7745d02e0 1004 mfio = 1; mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1005 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 62:21a7745d02e0 1006
phonemacro 62:21a7745d02e0 1007 // Set LED4 current
phonemacro 62:21a7745d02e0 1008 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x0;
phonemacro 62:21a7745d02e0 1009 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 62:21a7745d02e0 1010 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1011 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 62:21a7745d02e0 1012 mfio = 1; mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1013 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 62:21a7745d02e0 1014
phonemacro 62:21a7745d02e0 1015 // Set Red current
phonemacro 62:21a7745d02e0 1016 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x0;
phonemacro 62:21a7745d02e0 1017 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 62:21a7745d02e0 1018 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1019 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 62:21a7745d02e0 1020 mfio = 1; mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1021 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 62:21a7745d02e0 1022
phonemacro 62:21a7745d02e0 1023 // Set IR current
phonemacro 62:21a7745d02e0 1024 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0x0;
phonemacro 62:21a7745d02e0 1025 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 62:21a7745d02e0 1026 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1027 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 62:21a7745d02e0 1028 mfio = 1; mfio = 0; wait_us(300);
phonemacro 62:21a7745d02e0 1029 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 62:21a7745d02e0 1030 #endif
phonemacro 63:61f62564922c 1031 #if defined(MAXM86146_OPT_VALIDATION_RED)
phonemacro 63:61f62564922c 1032 // Set Green1 current
phonemacro 63:61f62564922c 1033 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x00;
phonemacro 63:61f62564922c 1034 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1035 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1036 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1037 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1038 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1039
phonemacro 63:61f62564922c 1040 // Set LED2 current
phonemacro 63:61f62564922c 1041 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1042 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1043 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1044 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1045 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1046 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1047
phonemacro 63:61f62564922c 1048 // Set Green2 current
phonemacro 63:61f62564922c 1049 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x0;
phonemacro 61:a2e73c5b87e7 1050 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1051 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1052 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1053 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1054 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1055
phonemacro 63:61f62564922c 1056 // Set LED4 current
phonemacro 63:61f62564922c 1057 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1058 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1059 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1060 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1061 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1062 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1063
phonemacro 63:61f62564922c 1064 // Set Red current to 1uA, 10uA or 30uA
phonemacro 63:61f62564922c 1065 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x29;
phonemacro 63:61f62564922c 1066 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1067 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1068 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1069 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1070 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1071
phonemacro 63:61f62564922c 1072 // Set IR current
phonemacro 63:61f62564922c 1073 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1074 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1075 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1076 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1077 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1078 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1079 #endif
phonemacro 63:61f62564922c 1080 #if defined(MAXM86146_OPT_VALIDATION_IR)
phonemacro 63:61f62564922c 1081 // Set Green1 current
phonemacro 63:61f62564922c 1082 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x00;
phonemacro 61:a2e73c5b87e7 1083 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1084 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1085 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1086 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1087 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1088
phonemacro 63:61f62564922c 1089 // Set LED2 current
phonemacro 63:61f62564922c 1090 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1091 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1092 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1093 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1094 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1095 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1096
phonemacro 63:61f62564922c 1097 // Set Green2 current
phonemacro 63:61f62564922c 1098 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1099 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1100 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1101 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1102 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1103 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1104
phonemacro 63:61f62564922c 1105 // Set LED4 current
phonemacro 63:61f62564922c 1106 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1107 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1108 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1109 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1110 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1111 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1112
phonemacro 61:a2e73c5b87e7 1113 // Set Red current
phonemacro 63:61f62564922c 1114 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x0;
phonemacro 63:61f62564922c 1115 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 63:61f62564922c 1116 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1117 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 63:61f62564922c 1118 mfio = 1; mfio = 0; wait_us(300);
phonemacro 63:61f62564922c 1119 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 63:61f62564922c 1120
phonemacro 63:61f62564922c 1121 // Set IR current to 1uA, 10uA or 30uA
phonemacro 63:61f62564922c 1122 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0x29;
phonemacro 61:a2e73c5b87e7 1123 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1124 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1125 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1126 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1127 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1128 #endif
phonemacro 61:a2e73c5b87e7 1129
phonemacro 62:21a7745d02e0 1130 #if defined(MAXM86146_OPT_VALIDATION_XTALK)
phonemacro 64:10da950111dd 1131 // Set Green1 current
phonemacro 66:d4989829a23d 1132 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0xff;
phonemacro 61:a2e73c5b87e7 1133 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1134 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1135 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1136 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1137 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1138
phonemacro 64:10da950111dd 1139 // Set LED2 current
phonemacro 64:10da950111dd 1140 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x0;
phonemacro 64:10da950111dd 1141 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 64:10da950111dd 1142 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 64:10da950111dd 1143 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 64:10da950111dd 1144 mfio = 1; mfio = 0; wait_us(300);
phonemacro 64:10da950111dd 1145 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 64:10da950111dd 1146
phonemacro 64:10da950111dd 1147 // Set Green2 current
phonemacro 66:d4989829a23d 1148 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0xff;
phonemacro 61:a2e73c5b87e7 1149 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1150 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1151 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1152 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1153 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1154
phonemacro 64:10da950111dd 1155 // Set LED4 current
phonemacro 64:10da950111dd 1156 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x0;
phonemacro 64:10da950111dd 1157 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 64:10da950111dd 1158 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 64:10da950111dd 1159 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 64:10da950111dd 1160 mfio = 1; mfio = 0; wait_us(300);
phonemacro 64:10da950111dd 1161 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 64:10da950111dd 1162
phonemacro 61:a2e73c5b87e7 1163 // Set Red current
phonemacro 66:d4989829a23d 1164 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0xff;
phonemacro 64:10da950111dd 1165 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 64:10da950111dd 1166 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 64:10da950111dd 1167 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 64:10da950111dd 1168 mfio = 1; mfio = 0; wait_us(300);
phonemacro 64:10da950111dd 1169 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 64:10da950111dd 1170
phonemacro 64:10da950111dd 1171 // Set IR current
phonemacro 66:d4989829a23d 1172 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0xff;
phonemacro 61:a2e73c5b87e7 1173 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1174 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1175 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1176 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1177 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1178 #endif
phonemacro 61:a2e73c5b87e7 1179
phonemacro 61:a2e73c5b87e7 1180 // configure LED Range
phonemacro 61:a2e73c5b87e7 1181 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x2A; cmd[3] = 0x3F;
phonemacro 61:a2e73c5b87e7 1182 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 61:a2e73c5b87e7 1183 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1184 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 61:a2e73c5b87e7 1185 mfio = 1; mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1186 pc.printf("wr afe reg Status: %x\n\r", rsp[0]);
phonemacro 61:a2e73c5b87e7 1187
phonemacro 61:a2e73c5b87e7 1188
phonemacro 61:a2e73c5b87e7 1189 }
phonemacro 61:a2e73c5b87e7 1190
phonemacro 14:c8cc6d7fd5f9 1191 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 1192 // init_sh_raw
phonemacro 14:c8cc6d7fd5f9 1193 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 1194 void init_sh_raw(void) {
phonemacro 29:a7dd81450b35 1195 char cmd[16];
phonemacro 14:c8cc6d7fd5f9 1196 char rsp[256];
phonemacro 61:a2e73c5b87e7 1197 // switch to application mode
phonemacro 61:a2e73c5b87e7 1198 rst = 0;
phonemacro 61:a2e73c5b87e7 1199 mfio = 1;
phonemacro 61:a2e73c5b87e7 1200 thread_sleep_for(10);
phonemacro 61:a2e73c5b87e7 1201 rst = 1;
phonemacro 61:a2e73c5b87e7 1202 thread_sleep_for(1500);
phonemacro 61:a2e73c5b87e7 1203 #ifdef MAXREFDES103_CFG
phonemacro 61:a2e73c5b87e7 1204 init_max20303_pmic();
phonemacro 61:a2e73c5b87e7 1205 #endif
phonemacro 14:c8cc6d7fd5f9 1206
phonemacro 14:c8cc6d7fd5f9 1207 mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1208
phonemacro 32:92adfbe18ab6 1209 //1.0 read operating mode
phonemacro 14:c8cc6d7fd5f9 1210 cmd[0] = 0x02; cmd[1] = 0x00;
phonemacro 14:c8cc6d7fd5f9 1211 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 14:c8cc6d7fd5f9 1212 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1213 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 14:c8cc6d7fd5f9 1214 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1215 pc.printf("\n\r 0x02 0x00 Status, Read Operating Mode: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 32:92adfbe18ab6 1216 //1.1 rd ver
phonemacro 14:c8cc6d7fd5f9 1217 cmd[0] = 0xFF; cmd[1] = 0x03;
phonemacro 14:c8cc6d7fd5f9 1218 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 14:c8cc6d7fd5f9 1219 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1220 sh_i2c.read(SH_ADDR, rsp, 4);
phonemacro 14:c8cc6d7fd5f9 1221 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1222 pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]);
phonemacro 14:c8cc6d7fd5f9 1223
phonemacro 32:92adfbe18ab6 1224 // raw1.2 sensor data
phonemacro 14:c8cc6d7fd5f9 1225 cmd[0] = 0x10; cmd[1] = 0x00; cmd[2] = 0x01;
phonemacro 14:c8cc6d7fd5f9 1226 pc.printf("raw sensor data only \n\r");
phonemacro 14:c8cc6d7fd5f9 1227 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 14:c8cc6d7fd5f9 1228 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1229 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1230 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 1231 pc.printf("raw1.2 Status: %x\n\r", rsp[0]);
phonemacro 32:92adfbe18ab6 1232 // raw1.3 interrupt threshold
phonemacro 14:c8cc6d7fd5f9 1233 cmd[0] = 0x10; cmd[1] = 0x01; cmd[2] = 0x01;
phonemacro 14:c8cc6d7fd5f9 1234 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 14:c8cc6d7fd5f9 1235 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1236 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1237 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 1238 pc.printf("raw1.3 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1239 #ifdef MAXM86146_CFG
phonemacro 50:dd2f60ab5686 1240 //1.20 map leds to slots for MAXM86146
phonemacro 50:dd2f60ab5686 1241 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x13; cmd[4] = 0x56; cmd[5] = 0x00;
phonemacro 50:dd2f60ab5686 1242 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 50:dd2f60ab5686 1243 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1244 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 1245 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1246 pc.printf("map leds to slots %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1247 //1.21 map HR inputs to slots
phonemacro 50:dd2f60ab5686 1248 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x11;
phonemacro 50:dd2f60ab5686 1249 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 50:dd2f60ab5686 1250 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1251 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 1252 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1253 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1254 //1.22 map SpO2 inputs to slots
phonemacro 50:dd2f60ab5686 1255 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x30; cmd[4] = 0x20;
phonemacro 50:dd2f60ab5686 1256 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 50:dd2f60ab5686 1257 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1258 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 1259 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1260 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1261 #endif
phonemacro 50:dd2f60ab5686 1262
phonemacro 50:dd2f60ab5686 1263 // raw enable sh accel
phonemacro 14:c8cc6d7fd5f9 1264 cmd[0] = 0x44; cmd[1] = 0x04; cmd[2] = 0x01; cmd[3] = 0x00;
phonemacro 14:c8cc6d7fd5f9 1265 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 29:a7dd81450b35 1266 mfio = 1; thread_sleep_for(20); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1267 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 29:a7dd81450b35 1268 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1269 pc.printf("raw1.4 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1270 // raw enable AFE
phonemacro 61:a2e73c5b87e7 1271 // cmd[0] = 0x44; cmd[1] = 0x00; cmd[2] = 0x01; cmd[3] = 0x00;
phonemacro 30:77a30ea425da 1272 // sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 38:8ff33869be1f 1273 cmd[0] = 0x44; cmd[1] = 0x00; cmd[2] = 0x01; // 3 bytes // tested on 33.13.31/12
phonemacro 38:8ff33869be1f 1274 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 61:a2e73c5b87e7 1275 // cmd[0] = 0x44; cmd[1] = 0xFF; cmd[2] = 0x02; cmd[3] = 0x04; cmd[4] = 0x01; cmd[5] = 0x00; cmd[6] = 0x00; cmd[7] = 0x01; cmd[8] = 0x00;
phonemacro 55:04c9fad147d4 1276 // sh_i2c.write(SH_ADDR, cmd, 9);
phonemacro 55:04c9fad147d4 1277 mfio = 1; thread_sleep_for(465); mfio = 0; wait_us(300);
phonemacro 55:04c9fad147d4 1278 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 55:04c9fad147d4 1279 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 61:a2e73c5b87e7 1280 pc.printf("raw1.6 Status: %x\n\r", rsp[0]);
phonemacro 32:92adfbe18ab6 1281
phonemacro 50:dd2f60ab5686 1282 /// raw 1.20 AFE part id
phonemacro 50:dd2f60ab5686 1283 cmd[0] = 0x41; cmd[1] = 0x00; cmd[2] = 0xFF;
phonemacro 50:dd2f60ab5686 1284 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 50:dd2f60ab5686 1285 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1286 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 50:dd2f60ab5686 1287 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1288 pc.printf("raw1.6 part id Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 50:dd2f60ab5686 1289 // raw1.21 rd accel WHO reg
phonemacro 30:77a30ea425da 1290 cmd[0] = 0x41; cmd[1] = 0x04; cmd[2] = 0x0F;
phonemacro 30:77a30ea425da 1291 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 30:77a30ea425da 1292 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 30:77a30ea425da 1293 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 30:77a30ea425da 1294 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 1295 pc.printf("1.7 Who Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 32:92adfbe18ab6 1296
phonemacro 61:a2e73c5b87e7 1297 // raw1.8 sample rate
phonemacro 50:dd2f60ab5686 1298 #if RAW_HZ == 25
phonemacro 50:dd2f60ab5686 1299 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x00; // set AFE reg 0x12 to 25 Hz, ave 1
phonemacro 50:dd2f60ab5686 1300 #elif RAW_HZ == 50
phonemacro 50:dd2f60ab5686 1301 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x40; // set AFE reg 0x12 to 50 Hz
phonemacro 50:dd2f60ab5686 1302 #elif RAW_HZ == 100
phonemacro 46:553559610878 1303 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x18; // set AFE reg 0x12 to 100 Hz
phonemacro 50:dd2f60ab5686 1304 #elif RAW_HZ == 200
phonemacro 50:dd2f60ab5686 1305 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x20; // set AFE reg 0x12 to 200 Hz
phonemacro 50:dd2f60ab5686 1306 #elif RAW_HZ == 2004
phonemacro 50:dd2f60ab5686 1307 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x22; // set AFE reg 0x12 to 200 Hz, ave 4
phonemacro 46:553559610878 1308 #else
phonemacro 46:553559610878 1309 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x18; // set AFE reg 0x12 to 100 Hz
phonemacro 46:553559610878 1310 #endif
phonemacro 14:c8cc6d7fd5f9 1311 // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x20; // set AFE reg 0x12 to 200 Hz
phonemacro 14:c8cc6d7fd5f9 1312 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1313 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1314 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1315 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 1316 pc.printf("raw1.8 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1317 // LED1 current
phonemacro 50:dd2f60ab5686 1318 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1319 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1320 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1321 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1322 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1323 pc.printf("LED1 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1324 // LED2 current
phonemacro 50:dd2f60ab5686 1325 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x19;
phonemacro 50:dd2f60ab5686 1326 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 50:dd2f60ab5686 1327 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1328 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 1329 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1330 pc.printf("LED2 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1331 // LED3 current
phonemacro 50:dd2f60ab5686 1332 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1333 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1334 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1335 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1336 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1337 pc.printf("LED3 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1338 // LED4 current
phonemacro 50:dd2f60ab5686 1339 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1340 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1341 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1342 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1343 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1344 pc.printf("LED4 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1345 // LED5 current
phonemacro 50:dd2f60ab5686 1346 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1347 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1348 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1349 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1350 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1351 pc.printf("LED5 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1352 // LED6 current
phonemacro 50:dd2f60ab5686 1353 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1354 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1355 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1356 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1357 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1358 pc.printf("LED6 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1359 #if 0
phonemacro 14:c8cc6d7fd5f9 1360 // Set Seq cntrl1 LED2, LED1
phonemacro 14:c8cc6d7fd5f9 1361 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x20; cmd[3] = 0x21;
phonemacro 14:c8cc6d7fd5f9 1362 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1363 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1364 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1365 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1366 pc.printf("Seq cntrl1 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1367 // Set Seq cntrl2 LED4, LED3
phonemacro 14:c8cc6d7fd5f9 1368 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x21; cmd[3] = 0xA3;
phonemacro 14:c8cc6d7fd5f9 1369 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1370 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1371 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1372 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1373 pc.printf("Seq cntrl2 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1374 // Set Seq cntrl3 LED6, LED5
phonemacro 14:c8cc6d7fd5f9 1375 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x21;
phonemacro 14:c8cc6d7fd5f9 1376 // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x99; // Ambient
phonemacro 14:c8cc6d7fd5f9 1377 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1378 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1379 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1380 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1381 pc.printf("Seq cntrl3 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1382 #endif
phonemacro 61:a2e73c5b87e7 1383 set_reg_opt_validation();
phonemacro 28:315604f4b374 1384 mfio = 1;
phonemacro 28:315604f4b374 1385 }
phonemacro 14:c8cc6d7fd5f9 1386
phonemacro 14:c8cc6d7fd5f9 1387 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 1388 // main
phonemacro 14:c8cc6d7fd5f9 1389 /*****************************************************************************/
phonemacro 10:192ea88e964b 1390 int main()
phonemacro 10:192ea88e964b 1391 {
phonemacro 10:192ea88e964b 1392 sh_i2c.frequency(400000);
phonemacro 10:192ea88e964b 1393 int32_t ledcnt = 0;
phonemacro 10:192ea88e964b 1394 rLED = LED_OFF; gLED = LED_ON; bLED = LED_OFF;
phonemacro 10:192ea88e964b 1395 Ticker ticker; // calls a callback repeatedly with a timeout
phonemacro 28:315604f4b374 1396
phonemacro 28:315604f4b374 1397 #if 0 // test disable algo
phonemacro 28:315604f4b374 1398 char cmd[8];
phonemacro 28:315604f4b374 1399 char rsp[256];
phonemacro 28:315604f4b374 1400 // 3.1 Disable algo
phonemacro 28:315604f4b374 1401 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 1402 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x00;
phonemacro 28:315604f4b374 1403 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 1404 thread_sleep_for(465);
phonemacro 28:315604f4b374 1405 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 1406 pc.printf("3.1 disable algo: %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 1407 mfio = 1;
phonemacro 28:315604f4b374 1408 #endif
phonemacro 28:315604f4b374 1409
phonemacro 10:192ea88e964b 1410 //ticker.attach(callback(&blink_timer), BLINKING_RATE_MS); /* set timer for one second */
phonemacro 14:c8cc6d7fd5f9 1411 #ifdef RAW
phonemacro 14:c8cc6d7fd5f9 1412 init_sh_raw();
phonemacro 14:c8cc6d7fd5f9 1413 #else
phonemacro 14:c8cc6d7fd5f9 1414 init_sh_algo();
phonemacro 14:c8cc6d7fd5f9 1415 #endif
phonemacro 28:315604f4b374 1416 mfio = 1;
phonemacro 33:c8fbd904df3e 1417 heading_printed = 0;
phonemacro 8:e6ae69cfecbf 1418 #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG) || defined(MAXM86146_CFG)
phonemacro 6:e1b7190d6cb5 1419 Timer tmr1;
phonemacro 0:6f65cae31c54 1420 while (1) {
phonemacro 6:e1b7190d6cb5 1421 tmr1.start();
phonemacro 61:a2e73c5b87e7 1422 #if defined(RAW)
phonemacro 50:dd2f60ab5686 1423 #if RAW_HZ == 25
phonemacro 50:dd2f60ab5686 1424 if (tmr1.read_ms() >= 40) {
phonemacro 50:dd2f60ab5686 1425 #elif RAW_HZ == 50
phonemacro 50:dd2f60ab5686 1426 if (tmr1.read_ms() >= 20) {
phonemacro 50:dd2f60ab5686 1427 #elif RAW_HZ == 100
phonemacro 29:a7dd81450b35 1428 if (tmr1.read_ms() >= 10) {
phonemacro 50:dd2f60ab5686 1429 #elif RAW_HZ == 200 || RAW_HZ == 2004
phonemacro 50:dd2f60ab5686 1430 if (tmr1.read_ms() >= 5) {
phonemacro 46:553559610878 1431 #else
phonemacro 46:553559610878 1432 if (tmr1.read_ms() >= 10) {
phonemacro 46:553559610878 1433 #endif
phonemacro 29:a7dd81450b35 1434 #else
phonemacro 42:6f980909371f 1435 #ifdef REDUCE_RPT_PERIOD
phonemacro 42:6f980909371f 1436 #ifdef USE_FIFO_BUFFER_CNT
phonemacro 42:6f980909371f 1437 if (tmr1.read_ms() >= 40*REDUCE_RPT_PERIOD*USE_FIFO_BUFFER_CNT) {
phonemacro 42:6f980909371f 1438 #else
phonemacro 42:6f980909371f 1439 if (tmr1.read_ms() >= 40*REDUCE_RPT_PERIOD) {
phonemacro 42:6f980909371f 1440 #endif
phonemacro 42:6f980909371f 1441 #else
phonemacro 42:6f980909371f 1442 #ifdef USE_FIFO_BUFFER_CNT
phonemacro 42:6f980909371f 1443 if (tmr1.read_ms() >= 40*USE_FIFO_BUFFER_CNT) {
phonemacro 42:6f980909371f 1444 #else
phonemacro 28:315604f4b374 1445 if (tmr1.read_ms() >= 40) {
phonemacro 42:6f980909371f 1446 #endif
phonemacro 42:6f980909371f 1447 #endif
phonemacro 29:a7dd81450b35 1448 #endif
phonemacro 7:23b067817ab8 1449 tmr1.reset();
phonemacro 10:192ea88e964b 1450 read_sh_fifo();
phonemacro 7:23b067817ab8 1451 if ((ledcnt++ % 50) == 0)
phonemacro 6:e1b7190d6cb5 1452 gLED = !gLED;
phonemacro 0:6f65cae31c54 1453 }
phonemacro 0:6f65cae31c54 1454 }
phonemacro 6:e1b7190d6cb5 1455 #else
phonemacro 6:e1b7190d6cb5 1456 ticker.attach(callback(&fifo_timer), 0.040f);
phonemacro 6:e1b7190d6cb5 1457 while (1) {
phonemacro 6:e1b7190d6cb5 1458 if (Time_to_Read_PPG) {
phonemacro 10:192ea88e964b 1459 read_sh_fifo();
phonemacro 7:23b067817ab8 1460 if ((ledcnt++ % 50) == 0)
phonemacro 6:e1b7190d6cb5 1461 gLED = !gLED;
phonemacro 6:e1b7190d6cb5 1462 }
phonemacro 6:e1b7190d6cb5 1463 }
phonemacro 6:e1b7190d6cb5 1464 #endif
phonemacro 0:6f65cae31c54 1465 }