David Jung / Mbed OS MAX32664C_MAXM86146_Mode1_Optical

Mode1 Optical Validation

Dependencies:   max32630fthr

main.cpp@54:2f19a5a83a62, 2022-05-13 (annotated)

Committer:
phonemacro
Date:
Fri May 13 18:02:15 2022 +0000
Revision:
54:2f19a5a83a62
Parent:
53:034f646141ae
Child:
55:04c9fad147d4
add spo2 motion to prints.

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 16:ff1122f0624a 38 * https://os.mbed.com/users/phonemacro/code/MAX32664C_Example_Host_Code
phonemacro 16:ff1122f0624a 39 * Tera Term output is set to 115200 baud rate.
phonemacro 53:034f646141ae 40 * ver: 220512
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 53:034f646141ae 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 53:034f646141ae 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 46:553559610878 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 50:dd2f60ab5686 91 #define RAW_HZ 50 // Raw data rate
phonemacro 50:dd2f60ab5686 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 33:c8fbd904df3e 96
phonemacro 33:c8fbd904df3e 97 // Comment out both of the below for Normal Algorithm Samples Format
phonemacro 33:c8fbd904df3e 98 //#define EXTENDED_ALGO 1 // define this if you want the extended algo samples report format
phonemacro 35:67699bdae57e 99 //#define PACKED_NORMAL_ALGO 1 // define this if you want the packed normal algo samples report format, 33.13.31
phonemacro 45:d26b8bcce561 100 //#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 101 //#define AGC 1 // define this for AGC, otherwise the default is AEC
phonemacro 6:e1b7190d6cb5 102
phonemacro 51:e2214db671c0 103 //#define USE_SYN 1
phonemacro 42:6f980909371f 104
phonemacro 42:6f980909371f 105 //#define REDUCE_RPT_PERIOD 0x19 // Report samples every 25 frame.
phonemacro 45:d26b8bcce561 106 //#define USE_FIFO_BUFFER_CNT 5 // Allow the FIFO to accumulate this many samples
phonemacro 42:6f980909371f 107
phonemacro 6:e1b7190d6cb5 108 #ifdef MAXREFDES103_CFG
phonemacro 5:7f5a012747a5 109 #include "MAX20303.h"
phonemacro 6:e1b7190d6cb5 110 I2C sh_i2c_pmic(P5_7, P6_0);
phonemacro 5:7f5a012747a5 111 #endif
phonemacro 5:7f5a012747a5 112
phonemacro 32:92adfbe18ab6 113 #ifdef MAXM86146_CFG
phonemacro 32:92adfbe18ab6 114 #define PPG_SZ 36 //maxm86146
phonemacro 32:92adfbe18ab6 115 #else
phonemacro 32:92adfbe18ab6 116 #define PPG_SZ 18 //maxm86161, max86141
phonemacro 32:92adfbe18ab6 117 #endif
phonemacro 32:92adfbe18ab6 118 #define ACCEL_SZ 6 // accel
phonemacro 32:92adfbe18ab6 119 #define SENSOR_SZ (PPG_SZ+ACCEL_SZ)
phonemacro 32:92adfbe18ab6 120
phonemacro 32:92adfbe18ab6 121 #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 122 #define old_algo_sz 1 // 3x.12.0 or earlier; 32.9.x
phonemacro 28:315604f4b374 123 #endif
phonemacro 30:77a30ea425da 124
phonemacro 33:c8fbd904df3e 125 #ifdef old_algo_sz
phonemacro 18:f4c95b1c0efc 126 #ifdef EXTENDED_ALGO
phonemacro 33:c8fbd904df3e 127 #define ALGO_SZ 52 // 52 bytes, extended algo size for 3x.12.0
phonemacro 33:c8fbd904df3e 128 #elif defined(PACKED_NORMAL_ALGO)
phonemacro 33:c8fbd904df3e 129 #define ALGO_SZ 16 // 16 bytes, packed algo normal size for 33.31.31
phonemacro 18:f4c95b1c0efc 130 #else
phonemacro 42:6f980909371f 131 #define ALGO_SZ 20 // 20 bytes, normal algo size for 3x.12.0
phonemacro 18:f4c95b1c0efc 132 #endif
phonemacro 12:17a0bf823462 133 #else
phonemacro 18:f4c95b1c0efc 134 #ifdef EXTENDED_ALGO
phonemacro 33:c8fbd904df3e 135 #define ALGO_SZ 56 // 56 bytes, extended algo size for 3x.13.x+
phonemacro 18:f4c95b1c0efc 136 #else
phonemacro 33:c8fbd904df3e 137 #define ALGO_SZ 24 // 24 bytes, normal algo size for 3x.13.x+
phonemacro 18:f4c95b1c0efc 138 #endif
phonemacro 12:17a0bf823462 139 #endif
phonemacro 18:f4c95b1c0efc 140
phonemacro 0:6f65cae31c54 141 #ifdef ALGO_ONLY
phonemacro 0:6f65cae31c54 142 #define TTL_SZ (ALGO_SZ)
phonemacro 0:6f65cae31c54 143 #else
phonemacro 14:c8cc6d7fd5f9 144 #ifdef RAW
phonemacro 14:c8cc6d7fd5f9 145 #define TTL_SZ (PPG_SZ+ACCEL_SZ)
phonemacro 14:c8cc6d7fd5f9 146 #else
phonemacro 14:c8cc6d7fd5f9 147 #define TTL_SZ (PPG_SZ+ACCEL_SZ+ALGO_SZ)
phonemacro 14:c8cc6d7fd5f9 148 #endif
phonemacro 0:6f65cae31c54 149 #endif
phonemacro 0:6f65cae31c54 150
phonemacro 3:da975696b936 151 Serial pc(USBTX, USBRX, 115200);
phonemacro 0:6f65cae31c54 152 DigitalOut rLED(LED1);
phonemacro 0:6f65cae31c54 153 DigitalOut gLED(LED2);
phonemacro 0:6f65cae31c54 154 DigitalOut bLED(LED3);
phonemacro 6:e1b7190d6cb5 155
phonemacro 33:c8fbd904df3e 156 int32_t heading_printed; // has the heading been printed?
phonemacro 33:c8fbd904df3e 157
phonemacro 33:c8fbd904df3e 158
phonemacro 6:e1b7190d6cb5 159 //#define thread_sleep_for(x) wait_ms(x) // for older versions of mbed
phonemacro 0:6f65cae31c54 160
phonemacro 5:7f5a012747a5 161
phonemacro 6:e1b7190d6cb5 162 const int SH_ADDR = 0xAA;//0x55;
phonemacro 0:6f65cae31c54 163 int32_t Time_to_Read_PPG = 0;
phonemacro 0:6f65cae31c54 164
phonemacro 0:6f65cae31c54 165 #define BLINKING_RATE_MS 1000ms
phonemacro 0:6f65cae31c54 166 void blink_timer(void) {
phonemacro 0:6f65cae31c54 167 gLED = !gLED; /* blink the green LED */
phonemacro 0:6f65cae31c54 168 }
phonemacro 0:6f65cae31c54 169
phonemacro 0:6f65cae31c54 170 void fifo_timer(void) {
phonemacro 0:6f65cae31c54 171 Time_to_Read_PPG = 1;
phonemacro 0:6f65cae31c54 172 }
phonemacro 0:6f65cae31c54 173
phonemacro 14:c8cc6d7fd5f9 174 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 175 // read_sh_fifo
phonemacro 14:c8cc6d7fd5f9 176 /*****************************************************************************/
phonemacro 27:a45d6e38f2de 177 /*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*#*/
phonemacro 28:315604f4b374 178 #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 179 #ifdef OPTIMIZE_FIFO_READ // tested on MAXM86146EVSYS
phonemacro 27:a45d6e38f2de 180 int32_t check_fifo_countdown;
phonemacro 42:6f980909371f 181 #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 182 #endif
phonemacro 42:6f980909371f 183
phonemacro 10:192ea88e964b 184 void read_sh_fifo(void) {
phonemacro 33:c8fbd904df3e 185 char cmd[8], i, j, k, samples;
phonemacro 0:6f65cae31c54 186 char rsp[3000];
phonemacro 0:6f65cae31c54 187 int32_t ppg[12];
phonemacro 5:7f5a012747a5 188 int16_t accel[3];
phonemacro 33:c8fbd904df3e 189 int32_t tst[20];
phonemacro 12:17a0bf823462 190 int32_t status, opmode, hr, hr_conf, ibi, ibi_conf;
phonemacro 12:17a0bf823462 191 #ifdef EXTENDED_ALGO
phonemacro 12:17a0bf823462 192 int32_t walk_stp, run_stp, energy, amr, iadj1_rqt, iadj1, iadj2_rqt, iadj2, iadj3_rqt, iadj3;
phonemacro 12:17a0bf823462 193 int32_t intadj_rqt, intadj, smpladj_rqt, smpladj, rqt_smplave, afestatehr, hr_motion;
phonemacro 12:17a0bf823462 194 #endif
phonemacro 12:17a0bf823462 195 int32_t act, r, spo2, spo2_conf;
phonemacro 33:c8fbd904df3e 196 int32_t spo2_compl, spo2_lo, spo2_mo, spo2_lopi, spo2_unrel, spo2_state, ibi_offset, scd, inappro_ori;
phonemacro 0:6f65cae31c54 197 int32_t ptr = 0;
phonemacro 0:6f65cae31c54 198 int32_t sptr = 0;
phonemacro 1:da792e46a385 199 mfio = 0; wait_us(300);
phonemacro 0:6f65cae31c54 200 Time_to_Read_PPG = 0;
phonemacro 42:6f980909371f 201 samples = 1;
phonemacro 42:6f980909371f 202 #ifdef USE_FIFO_BUFFER_CNT
phonemacro 42:6f980909371f 203 samples = USE_FIFO_BUFFER_CNT;
phonemacro 42:6f980909371f 204 #endif
phonemacro 27:a45d6e38f2de 205 #if defined(OPTIMIZE_FIFO_READ)
phonemacro 27:a45d6e38f2de 206 check_fifo_countdown--;
phonemacro 27:a45d6e38f2de 207 if (check_fifo_countdown == 0) {
phonemacro 27:a45d6e38f2de 208 #endif
phonemacro 27:a45d6e38f2de 209
phonemacro 22:f6b366c3b954 210 #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG)
phonemacro 0:6f65cae31c54 211 // 2.1
phonemacro 27:a45d6e38f2de 212 cmd[0] = 0x00; cmd[1] = 0x00;
phonemacro 27:a45d6e38f2de 213 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 27:a45d6e38f2de 214 wait_us(100);
phonemacro 27:a45d6e38f2de 215 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 27:a45d6e38f2de 216 // pc.printf("2.1 Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 22:f6b366c3b954 217 #else
phonemacro 45:d26b8bcce561 218 // tested w/ 33.13.12 don't need 2.1
phonemacro 0:6f65cae31c54 219 #endif
phonemacro 0:6f65cae31c54 220 // 2.2
phonemacro 50:dd2f60ab5686 221 #if defined(PACKED_NORMAL_ALGO) || defined(USE_SYN)
phonemacro 35:67699bdae57e 222 cmd[0] = 0x20;
phonemacro 35:67699bdae57e 223 sh_i2c.write(SH_ADDR, cmd, 1);
phonemacro 35:67699bdae57e 224 #else
phonemacro 27:a45d6e38f2de 225 cmd[0] = 0x12; cmd[1] = 0x00;
phonemacro 27:a45d6e38f2de 226 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 35:67699bdae57e 227 #endif
phonemacro 27:a45d6e38f2de 228 wait_us(100);
phonemacro 27:a45d6e38f2de 229 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 35:67699bdae57e 230 // mfio = 1; mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 231
phonemacro 27:a45d6e38f2de 232 // pc.printf("2.2 Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 27:a45d6e38f2de 233 samples = rsp[1];
phonemacro 27:a45d6e38f2de 234 // pc.printf("num samples %d, (num*ttl)+1 %d\n\r", rsp[1], TTL_SZ*samples+1);
phonemacro 27:a45d6e38f2de 235 // pc.printf("num smpls %d \n\r", samples);
phonemacro 27:a45d6e38f2de 236 #if defined(OPTIMIZE_FIFO_READ)
phonemacro 27:a45d6e38f2de 237 }
phonemacro 27:a45d6e38f2de 238 if (check_fifo_countdown <= 0)
phonemacro 27:a45d6e38f2de 239 check_fifo_countdown = MAX_FIFO_CNT;
phonemacro 27:a45d6e38f2de 240 #endif
phonemacro 27:a45d6e38f2de 241
phonemacro 0:6f65cae31c54 242 // 2.3
phonemacro 50:dd2f60ab5686 243 #if defined(PACKED_NORMAL_ALGO) || defined(USE_SYN)
phonemacro 35:67699bdae57e 244 cmd[0] = 0x21;;
phonemacro 35:67699bdae57e 245 sh_i2c.write(SH_ADDR, cmd, 1);
phonemacro 35:67699bdae57e 246 #else
phonemacro 45:d26b8bcce561 247 cmd[0] = 0x12; cmd[1] = 0x01;
phonemacro 45:d26b8bcce561 248 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 35:67699bdae57e 249 #endif
phonemacro 45:d26b8bcce561 250 wait_us(100);
phonemacro 45:d26b8bcce561 251 sh_i2c.read(SH_ADDR, rsp, 1+(TTL_SZ*samples));
phonemacro 42:6f980909371f 252 //pc.printf("num smpls %d ttlsiz %d\n\r", samples, TTL_SZ);
phonemacro 35:67699bdae57e 253 // mfio = 1; mfio = 0; wait_us(300);
phonemacro 45:d26b8bcce561 254 mfio = 1;
phonemacro 21:67d58af1ec56 255
phonemacro 0:6f65cae31c54 256 status = rsp[0];
phonemacro 5:7f5a012747a5 257
phonemacro 0:6f65cae31c54 258 sptr = 1;
phonemacro 42:6f980909371f 259 for (i = 0; i < samples; i++) {
phonemacro 0:6f65cae31c54 260 ptr = sptr;
phonemacro 35:67699bdae57e 261 #if !defined(ALGO_ONLY)
phonemacro 2:563d90a111b3 262 ppg[0] = (rsp[ptr+0] << 16) | (rsp[ptr+1] << 8) | (rsp[ptr+2]);
phonemacro 2:563d90a111b3 263 ppg[1] = (rsp[ptr+3] << 16) | (rsp[ptr+4] << 8) | (rsp[ptr+5]);
phonemacro 2:563d90a111b3 264 ppg[2] = (rsp[ptr+6] << 16) | (rsp[ptr+7] << 8) | (rsp[ptr+8]);
phonemacro 3:da975696b936 265 ppg[3] = (rsp[ptr+9] << 16) | (rsp[ptr+10] << 8) | (rsp[ptr+11]);
phonemacro 4:4f1e9439f048 266 ppg[4] = (rsp[ptr+12] << 16) | (rsp[ptr+13] << 8) | (rsp[ptr+14]);
phonemacro 4:4f1e9439f048 267 ppg[5] = (rsp[ptr+15] << 16) | (rsp[ptr+16] << 8) | (rsp[ptr+17]);
phonemacro 3:da975696b936 268 pc.printf("%d,%d,%d,%d,", ppg[0], ppg[1], ppg[2], ppg[3]);
phonemacro 47:346a13fbdc0f 269 #if defined(RAW) || defined(SPO2_CAL_RPT)
phonemacro 50:dd2f60ab5686 270 #if RAW_HZ <= 100
phonemacro 50:dd2f60ab5686 271 pc.printf("%d,%d,", ppg[4], ppg[5]);
phonemacro 50:dd2f60ab5686 272 #endif
phonemacro 47:346a13fbdc0f 273 #endif
phonemacro 14:c8cc6d7fd5f9 274 #ifdef MAXM86146_CFG
phonemacro 47:346a13fbdc0f 275 #if defined(RAW) || defined(SPO2_CAL_RPT)
phonemacro 14:c8cc6d7fd5f9 276 ppg[6] = (rsp[ptr+18] << 16) | (rsp[ptr+19] << 8) | (rsp[ptr+20]);
phonemacro 14:c8cc6d7fd5f9 277 ppg[7] = (rsp[ptr+21] << 16) | (rsp[ptr+22] << 8) | (rsp[ptr+23]);
phonemacro 14:c8cc6d7fd5f9 278 ppg[8] = (rsp[ptr+24] << 16) | (rsp[ptr+25] << 8) | (rsp[ptr+26]);
phonemacro 14:c8cc6d7fd5f9 279 ppg[9] = (rsp[ptr+27] << 16) | (rsp[ptr+28] << 8) | (rsp[ptr+29]);
phonemacro 14:c8cc6d7fd5f9 280 ppg[10] = (rsp[ptr+30] << 16) | (rsp[ptr+31] << 8) | (rsp[ptr+32]);
phonemacro 14:c8cc6d7fd5f9 281 ppg[11] = (rsp[ptr+33] << 16) | (rsp[ptr+34] << 8) | (rsp[ptr+35]);
phonemacro 50:dd2f60ab5686 282 #if RAW_HZ <= 100
phonemacro 14:c8cc6d7fd5f9 283 pc.printf("%d,%d,%d,%d,%d,%d,", ppg[6], ppg[7],ppg[8], ppg[9],ppg[10], ppg[11]);
phonemacro 50:dd2f60ab5686 284 #endif
phonemacro 36:a6e7ff9c87a0 285 #endif // raw
phonemacro 36:a6e7ff9c87a0 286 #endif // MAXM86146_CFG
phonemacro 44:1b165a68474d 287 accel[0] = (rsp[1+PPG_SZ+0] << 8) | (rsp[1+PPG_SZ+1]);
phonemacro 44:1b165a68474d 288 accel[1] = (rsp[1+PPG_SZ+2] << 8) | (rsp[1+PPG_SZ+3]);
phonemacro 44:1b165a68474d 289 accel[2] = (rsp[1+PPG_SZ+4] << 8) | (rsp[1+PPG_SZ+5]);
phonemacro 5:7f5a012747a5 290 pc.printf("%d,%d,%d,", accel[0], accel[1], accel[2]);
phonemacro 5:7f5a012747a5 291
phonemacro 0:6f65cae31c54 292 ptr = sptr + SENSOR_SZ;
phonemacro 36:a6e7ff9c87a0 293
phonemacro 36:a6e7ff9c87a0 294 #endif //!defined(ALGO_ONLY)
phonemacro 29:a7dd81450b35 295
phonemacro 14:c8cc6d7fd5f9 296 #ifndef RAW
phonemacro 12:17a0bf823462 297 #ifdef EXTENDED_ALGO
phonemacro 45:d26b8bcce561 298 // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ);
phonemacro 0:6f65cae31c54 299 opmode = rsp[ptr];
phonemacro 0:6f65cae31c54 300 hr = (rsp[ptr+1] << 8) + rsp[ptr+2];
phonemacro 0:6f65cae31c54 301 hr_conf = rsp[ptr+3];
phonemacro 12:17a0bf823462 302 ibi = (rsp[ptr+4] << 8) + rsp[ptr+5];
phonemacro 12:17a0bf823462 303
phonemacro 12:17a0bf823462 304 ibi_conf = rsp[ptr+6];
phonemacro 12:17a0bf823462 305 act = rsp[ptr+7];
phonemacro 12:17a0bf823462 306 walk_stp = (rsp[ptr+8] << 24) + (rsp[ptr+9] << 16) + (rsp[ptr+10] << 8) + rsp[ptr+11];
phonemacro 12:17a0bf823462 307 run_stp = (rsp[ptr+12] << 24) + (rsp[ptr+13] << 16) + (rsp[ptr+14] << 8) + rsp[ptr+15];
phonemacro 12:17a0bf823462 308
phonemacro 12:17a0bf823462 309 energy = (rsp[ptr+16] << 24) + (rsp[ptr+17] << 16) + (rsp[ptr+18] << 8) + rsp[ptr+19];
phonemacro 12:17a0bf823462 310 amr = (rsp[ptr+20] << 24) + (rsp[ptr+21] << 16) + (rsp[ptr+22] << 8) + rsp[ptr+23];
phonemacro 12:17a0bf823462 311 iadj1_rqt = rsp[ptr+24];
phonemacro 12:17a0bf823462 312 iadj1 = (rsp[ptr+25] << 8) + rsp[ptr+26];
phonemacro 12:17a0bf823462 313
phonemacro 12:17a0bf823462 314 iadj2_rqt = rsp[ptr+27];
phonemacro 12:17a0bf823462 315 iadj2 = (rsp[ptr+28] << 8) + rsp[ptr+29];
phonemacro 12:17a0bf823462 316 iadj3_rqt = rsp[ptr+30];
phonemacro 12:17a0bf823462 317 iadj3 = (rsp[ptr+31] << 8) + rsp[ptr+32];
phonemacro 12:17a0bf823462 318
phonemacro 12:17a0bf823462 319 intadj_rqt = rsp[ptr+33];
phonemacro 12:17a0bf823462 320 intadj = rsp[ptr+34];
phonemacro 12:17a0bf823462 321 smpladj_rqt = rsp[ptr+35];
phonemacro 12:17a0bf823462 322 smpladj = rsp[ptr+36];
phonemacro 12:17a0bf823462 323
phonemacro 12:17a0bf823462 324 rqt_smplave = rsp[ptr+37];
phonemacro 12:17a0bf823462 325 afestatehr = rsp[ptr+38];
phonemacro 12:17a0bf823462 326 hr_motion = rsp[ptr+39];
phonemacro 12:17a0bf823462 327 scd = rsp[ptr+40];
phonemacro 12:17a0bf823462 328
phonemacro 12:17a0bf823462 329
phonemacro 12:17a0bf823462 330 r = (rsp[ptr+41] << 8) + rsp[ptr+42];
phonemacro 12:17a0bf823462 331 spo2_conf = rsp[ptr+43];
phonemacro 12:17a0bf823462 332
phonemacro 12:17a0bf823462 333 spo2 = (rsp[ptr+44] << 8) + rsp[ptr+45];
phonemacro 12:17a0bf823462 334 spo2_compl = rsp[ptr+46];
phonemacro 53:034f646141ae 335 spo2_lo = rsp[ptr+47]; // low quality
phonemacro 12:17a0bf823462 336 spo2_mo = rsp[ptr+48];
phonemacro 12:17a0bf823462 337
phonemacro 12:17a0bf823462 338 spo2_lopi = rsp[ptr+49];
phonemacro 12:17a0bf823462 339 spo2_unrel = rsp[ptr+50];
phonemacro 12:17a0bf823462 340 spo2_state = rsp[ptr+51];
phonemacro 12:17a0bf823462 341
phonemacro 12:17a0bf823462 342 ibi_offset = rsp[ptr+52];
phonemacro 12:17a0bf823462 343
phonemacro 12:17a0bf823462 344 sptr += (TTL_SZ);
phonemacro 36:a6e7ff9c87a0 345
phonemacro 12:17a0bf823462 346 #if 1
phonemacro 33:c8fbd904df3e 347 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 348 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 349 #if defined(ALGO_ONLY)
phonemacro 33:c8fbd904df3e 350 pc.printf("opmode,hr,hr_conf,ibi,ibi_conf,act,walk_stp,run_stp,energy,amr,");
phonemacro 33:c8fbd904df3e 351 pc.printf("iadj1_rqt,iadj1,iadj2_rqt,iadj2,iadj3_rqt,iadj3,intadj_rqt,intadj,");
phonemacro 33:c8fbd904df3e 352 pc.printf("smpladj_rqt,smpladj,rqt_smplave,afestatehr,hr_motion,scd,");
phonemacro 51:e2214db671c0 353 pc.printf("r,");
phonemacro 33:c8fbd904df3e 354 pc.printf("spo2,spo2_compl,spo2_lo,spo2_mo,spo2_lopi,spo2_unrel,spo2_state,ibi_offset,\n\r");
phonemacro 36:a6e7ff9c87a0 355 #endif
phonemacro 33:c8fbd904df3e 356 }
phonemacro 12:17a0bf823462 357 pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi);
phonemacro 12:17a0bf823462 358 pc.printf("%d,%d,", ibi_conf, act);
phonemacro 12:17a0bf823462 359 pc.printf("%d,%d,%d,", walk_stp, run_stp, energy);
phonemacro 12:17a0bf823462 360 pc.printf("%d,%d,%d,%d,", amr, iadj1_rqt, iadj1, iadj2_rqt);
phonemacro 12:17a0bf823462 361 pc.printf("%d,%d,%d,%d,", iadj2, iadj3_rqt, iadj3, intadj_rqt);
phonemacro 12:17a0bf823462 362 pc.printf("%d,%d,%d,%d,", intadj, smpladj_rqt, smpladj, rqt_smplave);
phonemacro 12:17a0bf823462 363 pc.printf("%d,%d,", afestatehr, hr_motion);
phonemacro 51:e2214db671c0 364 pc.printf("%d,%d", scd, r);
phonemacro 12:17a0bf823462 365 pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo);
phonemacro 12:17a0bf823462 366 pc.printf("%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state);
phonemacro 12:17a0bf823462 367 pc.printf("%d,", ibi_offset);
phonemacro 12:17a0bf823462 368 #else
phonemacro 33:c8fbd904df3e 369 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 370 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 371 #if defined(ALGO_ONLY)
phonemacro 53:034f646141ae 372 pc.printf("hr,r,hr_conf,spo2,spo2_conf,spo2_lo,spo2_unrel,spo2_state,scd,\n\r");
phonemacro 36:a6e7ff9c87a0 373 #endif
phonemacro 33:c8fbd904df3e 374 }
phonemacro 51:e2214db671c0 375 pc.printf("%d,%d,%d", hr, hr_conf, r);
phonemacro 12:17a0bf823462 376 pc.printf("%d,%d,", spo2, spo2_conf);
phonemacro 16:ff1122f0624a 377 pc.printf("%d,%d,%d,", spo2_lo, spo2_mo, spo2_lopi);
phonemacro 53:034f646141ae 378 pc.printf("%d,%d,%d,", spo2_unrel,spo2_state, scd);
phonemacro 36:a6e7ff9c87a0 379 #endif // if 1
phonemacro 33:c8fbd904df3e 380 #elif defined(PACKED_NORMAL_ALGO)
phonemacro 33:c8fbd904df3e 381 // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ);
phonemacro 35:67699bdae57e 382 opmode = rsp[ptr];
phonemacro 33:c8fbd904df3e 383 hr = (rsp[ptr+1] << 8) + rsp[ptr+2];
phonemacro 33:c8fbd904df3e 384 hr_conf = rsp[ptr+3];
phonemacro 33:c8fbd904df3e 385 ibi = (rsp[ptr+4] << 8) + rsp[ptr+5];
phonemacro 33:c8fbd904df3e 386
phonemacro 33:c8fbd904df3e 387 ibi_conf = rsp[ptr+6];
phonemacro 33:c8fbd904df3e 388 // act = rsp[ptr+7];
phonemacro 33:c8fbd904df3e 389 r = (rsp[ptr+7] << 8) + rsp[ptr+8];
phonemacro 33:c8fbd904df3e 390 spo2_conf = rsp[ptr+9];
phonemacro 33:c8fbd904df3e 391
phonemacro 33:c8fbd904df3e 392 spo2 = (rsp[ptr+10] << 8) + rsp[ptr+11];
phonemacro 33:c8fbd904df3e 393 spo2_compl = rsp[ptr+12];
phonemacro 33:c8fbd904df3e 394
phonemacro 33:c8fbd904df3e 395 spo2_lo = 0; spo2_mo = 0; spo2_lopi = 0; spo2_unrel = 0;
phonemacro 33:c8fbd904df3e 396
phonemacro 33:c8fbd904df3e 397 if (rsp[ptr+13] & 0x01)
phonemacro 33:c8fbd904df3e 398 spo2_lo = 1;
phonemacro 33:c8fbd904df3e 399 if (rsp[ptr+13] & 0x02)
phonemacro 33:c8fbd904df3e 400 spo2_mo = 1;
phonemacro 33:c8fbd904df3e 401 if (rsp[ptr+13] & 0x04)
phonemacro 33:c8fbd904df3e 402 spo2_lopi = 1;
phonemacro 33:c8fbd904df3e 403 if (rsp[ptr+13] & 0x08)
phonemacro 33:c8fbd904df3e 404 spo2_unrel = 1;
phonemacro 33:c8fbd904df3e 405 spo2_state = (0x30 & rsp[ptr+13]) >> 4;
phonemacro 33:c8fbd904df3e 406
phonemacro 33:c8fbd904df3e 407 scd = (0x03 & rsp[ptr+14]);
phonemacro 33:c8fbd904df3e 408 act = (0x1C & rsp[ptr+14]) >> 2;
phonemacro 33:c8fbd904df3e 409 inappro_ori = (0x20 & rsp[ptr+14]) >> 5;
phonemacro 33:c8fbd904df3e 410
phonemacro 33:c8fbd904df3e 411 ibi_offset = rsp[ptr+15];
phonemacro 33:c8fbd904df3e 412
phonemacro 33:c8fbd904df3e 413 sptr += (TTL_SZ);
phonemacro 37:249b548e6488 414 #if defined(PCK_CFG_MASK) // hex out, for printing config masked out packed data
phonemacro 35:67699bdae57e 415 // print as hex bytes
phonemacro 35:67699bdae57e 416 for (j=0; j<ALGO_SZ; j++)
phonemacro 35:67699bdae57e 417 pc.printf("%02X ", rsp[ptr+j]);
phonemacro 36:a6e7ff9c87a0 418 //pc.printf("\n\r" );
phonemacro 35:67699bdae57e 419 #endif
phonemacro 35:67699bdae57e 420
phonemacro 37:249b548e6488 421 #if !defined(PCK_CFG_MASK)
phonemacro 37:249b548e6488 422 #if 1
phonemacro 37:249b548e6488 423 #if 1 // print all
phonemacro 33:c8fbd904df3e 424 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 425 heading_printed = 1;
phonemacro 37:249b548e6488 426 #if defined(ALGO_ONLY)
phonemacro 33:c8fbd904df3e 427 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 428 #endif
phonemacro 33:c8fbd904df3e 429 }
phonemacro 33:c8fbd904df3e 430 pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi);
phonemacro 33:c8fbd904df3e 431 pc.printf("%d,%d,%d,%d,", ibi_conf, act, r, spo2_conf);
phonemacro 33:c8fbd904df3e 432 pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo);
phonemacro 33:c8fbd904df3e 433 pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state, scd);
phonemacro 33:c8fbd904df3e 434 pc.printf("%d,", ibi_offset);
phonemacro 33:c8fbd904df3e 435 pc.printf("%d,", inappro_ori);
phonemacro 37:249b548e6488 436 #endif
phonemacro 37:249b548e6488 437 #else // print some
phonemacro 33:c8fbd904df3e 438 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 439 heading_printed = 1;
phonemacro 37:249b548e6488 440 #if defined(ALGO_ONLY)
phonemacro 54:2f19a5a83a62 441 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 442 #endif
phonemacro 33:c8fbd904df3e 443 }
phonemacro 51:e2214db671c0 444 pc.printf("%d,%d,%d", hr, hr_conf, r);
phonemacro 33:c8fbd904df3e 445 pc.printf("%d,%d,", spo2, spo2_conf);
phonemacro 54:2f19a5a83a62 446 pc.printf("%d,%d,", spo2_lo,spo2_mo);
phonemacro 53:034f646141ae 447 pc.printf("%d,%d,%d,%d", spo2_lopi,spo2_unrel, spo2_state, scd);
phonemacro 37:249b548e6488 448 #endif
phonemacro 37:249b548e6488 449 #endif // #if defined(PCK_CFG_MASK)
phonemacro 37:249b548e6488 450
phonemacro 12:17a0bf823462 451 #else // normal algo size
phonemacro 12:17a0bf823462 452 // pc.printf("ptr %d ttlsiz %d ", ptr, TTL_SZ);
phonemacro 12:17a0bf823462 453 opmode = rsp[ptr];
phonemacro 12:17a0bf823462 454 hr = (rsp[ptr+1] << 8) + rsp[ptr+2];
phonemacro 12:17a0bf823462 455 hr_conf = rsp[ptr+3];
phonemacro 12:17a0bf823462 456 ibi = (rsp[ptr+4] << 8) + rsp[ptr+5];
phonemacro 4:4f1e9439f048 457
phonemacro 11:a16b6bf38841 458 ibi_conf = rsp[ptr+6];
phonemacro 3:da975696b936 459 act = rsp[ptr+7];
phonemacro 3:da975696b936 460 r = (rsp[ptr+8] << 8) + rsp[ptr+9];
phonemacro 0:6f65cae31c54 461 spo2_conf = rsp[ptr+10];
phonemacro 4:4f1e9439f048 462
phonemacro 0:6f65cae31c54 463 spo2 = (rsp[ptr+11] << 8) + rsp[ptr+12];
phonemacro 4:4f1e9439f048 464 spo2_compl = rsp[ptr+13];
phonemacro 4:4f1e9439f048 465 spo2_lo = rsp[ptr+14];
phonemacro 4:4f1e9439f048 466 spo2_mo = rsp[ptr+15];
phonemacro 4:4f1e9439f048 467
phonemacro 4:4f1e9439f048 468 spo2_lopi = rsp[ptr+16];
phonemacro 4:4f1e9439f048 469 spo2_unrel = rsp[ptr+17];
phonemacro 4:4f1e9439f048 470 spo2_state = rsp[ptr+18];
phonemacro 2:563d90a111b3 471 scd = rsp[ptr+19];
phonemacro 0:6f65cae31c54 472
phonemacro 36:a6e7ff9c87a0 473 // ibi_offset = rsp[ptr+20];
phonemacro 0:6f65cae31c54 474
phonemacro 4:4f1e9439f048 475 sptr += (TTL_SZ);
phonemacro 36:a6e7ff9c87a0 476
phonemacro 27:a45d6e38f2de 477 #if 0
phonemacro 33:c8fbd904df3e 478 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 479 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 480 #if defined(ALGO_ONLY)
phonemacro 33:c8fbd904df3e 481 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 482 #endif
phonemacro 33:c8fbd904df3e 483 }
phonemacro 4:4f1e9439f048 484 pc.printf("%d,%d,%d,%d,", opmode, hr, hr_conf, ibi);
phonemacro 4:4f1e9439f048 485 pc.printf("%d,%d,%d,%d,", ibi_conf, act, r, spo2_conf);
phonemacro 4:4f1e9439f048 486 pc.printf("%d,%d,%d,%d,", spo2, spo2_compl, spo2_lo, spo2_mo);
phonemacro 4:4f1e9439f048 487 pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel, spo2_state, scd);
phonemacro 36:a6e7ff9c87a0 488 // pc.printf("%d,", ibi_offset);
phonemacro 4:4f1e9439f048 489 #else
phonemacro 33:c8fbd904df3e 490 if (heading_printed == 0) {
phonemacro 33:c8fbd904df3e 491 heading_printed = 1;
phonemacro 36:a6e7ff9c87a0 492 #if defined(ALGO_ONLY)
phonemacro 54:2f19a5a83a62 493 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 494 #endif
phonemacro 33:c8fbd904df3e 495 }
phonemacro 51:e2214db671c0 496 pc.printf("%d,%d,%d,", hr, hr_conf, r);
phonemacro 4:4f1e9439f048 497 pc.printf("%d,%d,", spo2, spo2_conf);
phonemacro 54:2f19a5a83a62 498 pc.printf("%d,%d,", spo2_lo,spo2_mo);
phonemacro 53:034f646141ae 499 pc.printf("%d,%d,%d,%d,", spo2_lopi,spo2_unrel,spo2_state, scd);
phonemacro 4:4f1e9439f048 500 #endif
phonemacro 12:17a0bf823462 501 #endif // end normal algo size
phonemacro 14:c8cc6d7fd5f9 502 #endif // !RAW
phonemacro 4:4f1e9439f048 503
phonemacro 3:da975696b936 504 pc.printf("\n\r");
phonemacro 0:6f65cae31c54 505 }
phonemacro 0:6f65cae31c54 506 }
phonemacro 0:6f65cae31c54 507
phonemacro 6:e1b7190d6cb5 508 #ifdef MAXREFDES103_CFG
phonemacro 14:c8cc6d7fd5f9 509 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 510 // init_max20303_pmic
phonemacro 14:c8cc6d7fd5f9 511 /*****************************************************************************/
phonemacro 6:e1b7190d6cb5 512 void init_max20303_pmic(void) {
phonemacro 5:7f5a012747a5 513 /* Wait for pmic to settle down */
phonemacro 5:7f5a012747a5 514 thread_sleep_for(800);
phonemacro 5:7f5a012747a5 515
phonemacro 5:7f5a012747a5 516 //set_time(1544787300); // Set RTC time to Wed, 28 Oct 2009 11:35:37
phonemacro 6:e1b7190d6cb5 517 MAX20303 max20303(&sh_i2c);
phonemacro 5:7f5a012747a5 518 /*Set LDO1 to 1.8v*/
phonemacro 5:7f5a012747a5 519 max20303.LDO1Config();
phonemacro 5:7f5a012747a5 520
phonemacro 5:7f5a012747a5 521 /*Set LDO2 to 3v*/
phonemacro 5:7f5a012747a5 522 max20303.LDO2Config();
phonemacro 5:7f5a012747a5 523
phonemacro 5:7f5a012747a5 524 //max20303.BoostEnable();
phonemacro 5:7f5a012747a5 525 max20303.BuckBoostEnable();
phonemacro 5:7f5a012747a5 526
phonemacro 5:7f5a012747a5 527 max20303.led0on(0);
phonemacro 5:7f5a012747a5 528 max20303.led1on(0);
phonemacro 5:7f5a012747a5 529 max20303.led2on(0);
phonemacro 5:7f5a012747a5 530
phonemacro 5:7f5a012747a5 531 /* Wait for pmic to settle down */
phonemacro 5:7f5a012747a5 532 thread_sleep_for(200);
phonemacro 28:315604f4b374 533
phonemacro 5:7f5a012747a5 534 }
phonemacro 6:e1b7190d6cb5 535 #endif // MAXREFDES103_CFG
phonemacro 14:c8cc6d7fd5f9 536
phonemacro 14:c8cc6d7fd5f9 537 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 538 // init_sh_algo
phonemacro 14:c8cc6d7fd5f9 539 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 540 void init_sh_algo(void) {
phonemacro 35:67699bdae57e 541 char cmd[64];
phonemacro 0:6f65cae31c54 542 char rsp[256];
phonemacro 27:a45d6e38f2de 543
phonemacro 27:a45d6e38f2de 544 #ifdef OPTIMIZE_FIFO_READ
phonemacro 27:a45d6e38f2de 545 check_fifo_countdown = MAX_FIFO_CNT;
phonemacro 27:a45d6e38f2de 546 #endif
phonemacro 27:a45d6e38f2de 547
phonemacro 10:192ea88e964b 548 // switch to application mode
phonemacro 0:6f65cae31c54 549 rst = 0;
phonemacro 0:6f65cae31c54 550 mfio = 1;
phonemacro 0:6f65cae31c54 551 thread_sleep_for(10);
phonemacro 0:6f65cae31c54 552 rst = 1;
phonemacro 0:6f65cae31c54 553 thread_sleep_for(1500);
phonemacro 10:192ea88e964b 554 #ifdef MAXREFDES103_CFG
phonemacro 10:192ea88e964b 555 init_max20303_pmic();
phonemacro 10:192ea88e964b 556 #endif
phonemacro 47:346a13fbdc0f 557 // 33.13.31 needs at least 1.6s
phonemacro 47:346a13fbdc0f 558 // thread_sleep_for(100);
phonemacro 0:6f65cae31c54 559
phonemacro 1:da792e46a385 560 mfio = 0; wait_us(300);
phonemacro 42:6f980909371f 561 #ifdef REDUCE_RPT_PERIOD
phonemacro 42:6f980909371f 562 //Change report period to 25
phonemacro 42:6f980909371f 563 cmd[0] = 0x10; cmd[1] = 0x02; cmd[2] = REDUCE_RPT_PERIOD;
phonemacro 42:6f980909371f 564 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 42:6f980909371f 565 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 42:6f980909371f 566 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 42:6f980909371f 567 mfio = 1; mfio = 0; wait_us(300);
phonemacro 42:6f980909371f 568 pc.printf("Wr report period 25 %x\n\r", rsp[0]);
phonemacro 42:6f980909371f 569 #endif
phonemacro 48:6b93b56bb22e 570 //1.10 rd ver
phonemacro 4:4f1e9439f048 571 cmd[0] = 0xFF; cmd[1] = 0x03;
phonemacro 6:e1b7190d6cb5 572 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 1:da792e46a385 573 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 574 sh_i2c.read(SH_ADDR, rsp, 4);
phonemacro 1:da792e46a385 575 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 576 pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]);
phonemacro 0:6f65cae31c54 577
phonemacro 35:67699bdae57e 578 // wr config mask for packed normal data output fifo
phonemacro 37:249b548e6488 579 #if defined(PCK_CFG_MASK)
phonemacro 37:249b548e6488 580 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x20; cmd[3] = 0x7F; cmd[4] = 0xFF; cmd[5] = 0x00;
phonemacro 44:1b165a68474d 581 // cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x20; cmd[3] = 0xFF; cmd[4] = 0xFF; cmd[5] = 0x00;
phonemacro 35:67699bdae57e 582 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 35:67699bdae57e 583 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 584 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 35:67699bdae57e 585 mfio = 1; mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 586 pc.printf("wr config mask packed: %x \n\r", rsp[0]);
phonemacro 35:67699bdae57e 587 // rd config mask for packed normal data output fifo
phonemacro 35:67699bdae57e 588 cmd[0] = 0x51; cmd[1] = 0x07; cmd[2] = 0x20;
phonemacro 35:67699bdae57e 589 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 35:67699bdae57e 590 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 591 sh_i2c.read(SH_ADDR, rsp, 4);
phonemacro 35:67699bdae57e 592 mfio = 1; mfio = 0; wait_us(300);
phonemacro 35:67699bdae57e 593 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 594 #endif
phonemacro 35:67699bdae57e 595
phonemacro 33:c8fbd904df3e 596 #if defined(MAXM86161_CFG) || defined(MAXM86146_CFG)
phonemacro 33:c8fbd904df3e 597 // rd algo sz normal
phonemacro 17:0d6e99a0fd8d 598 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x01;
phonemacro 17:0d6e99a0fd8d 599 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 17:0d6e99a0fd8d 600 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 17:0d6e99a0fd8d 601 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 17:0d6e99a0fd8d 602 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 603 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 33:c8fbd904df3e 604 // rd algo sz extended
phonemacro 17:0d6e99a0fd8d 605 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x02;
phonemacro 17:0d6e99a0fd8d 606 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 17:0d6e99a0fd8d 607 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 17:0d6e99a0fd8d 608 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 17:0d6e99a0fd8d 609 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 610 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 33:c8fbd904df3e 611 // rd algo sz scd
phonemacro 17:0d6e99a0fd8d 612 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x03;
phonemacro 17:0d6e99a0fd8d 613 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 17:0d6e99a0fd8d 614 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 17:0d6e99a0fd8d 615 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 17:0d6e99a0fd8d 616 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 617 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 45:d26b8bcce561 618 #if defined(PACKED_NORMAL_ALGO) && (defined(MAXM86161_CFG) || defined(MAXM86146_CFG))
phonemacro 35:67699bdae57e 619 // rd algo sz packed normal
phonemacro 33:c8fbd904df3e 620 cmd[0] = 0x11; cmd[1] = 0x06; cmd[2] = 0x04;
phonemacro 33:c8fbd904df3e 621 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 33:c8fbd904df3e 622 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 623 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 33:c8fbd904df3e 624 mfio = 1; mfio = 0; wait_us(300);
phonemacro 33:c8fbd904df3e 625 pc.printf("rd algo size: %d %d \n\r", rsp[0], rsp[1]);
phonemacro 33:c8fbd904df3e 626 #endif
phonemacro 17:0d6e99a0fd8d 627 #endif
phonemacro 17:0d6e99a0fd8d 628
phonemacro 17:0d6e99a0fd8d 629 #if 0
phonemacro 17:0d6e99a0fd8d 630 // set Perfusion Index threshold to .05 (3x.13.19+)
phonemacro 17:0d6e99a0fd8d 631 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x1D; cmd[3] = 50;
phonemacro 16:ff1122f0624a 632 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 16:ff1122f0624a 633 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 16:ff1122f0624a 634 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 16:ff1122f0624a 635 mfio = 1; mfio = 0; wait_us(300);
phonemacro 16:ff1122f0624a 636 pc.printf("pi set to 0x19 : %x \n\r", rsp[0]);
phonemacro 17:0d6e99a0fd8d 637 #endif
phonemacro 16:ff1122f0624a 638
phonemacro 48:6b93b56bb22e 639 // 1.1 sensor and algo data
phonemacro 4:4f1e9439f048 640 cmd[0] = 0x10; cmd[1] = 0x00;
phonemacro 2:563d90a111b3 641 #ifdef ALGO_ONLY
phonemacro 0:6f65cae31c54 642 cmd[2] = 0x02; // algo data
phonemacro 4:4f1e9439f048 643 pc.printf("algo only \n\r");
phonemacro 2:563d90a111b3 644 #else
phonemacro 2:563d90a111b3 645 cmd[2] = 0x03; // sensor + algo data
phonemacro 4:4f1e9439f048 646 pc.printf("sens+algo \n\r");
phonemacro 2:563d90a111b3 647 #endif
phonemacro 6:e1b7190d6cb5 648 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 1:da792e46a385 649 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 650 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 651 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 652 pc.printf("1.2 Status: %x\n\r", rsp[0]);
phonemacro 52:e5aba237e804 653 // 1.4 Continuous HR, Spo2
phonemacro 52:e5aba237e804 654 #ifndef SPO2_CAL_RPT
phonemacro 32:92adfbe18ab6 655 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0A; cmd[3] = 0x00;
phonemacro 32:92adfbe18ab6 656 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 32:92adfbe18ab6 657 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 658 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 32:92adfbe18ab6 659 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 660 pc.printf("1.5 Status: %x\n\r", rsp[0]);
phonemacro 52:e5aba237e804 661 #endif
phonemacro 48:6b93b56bb22e 662 // 1.5 AEC enable (default)
phonemacro 4:4f1e9439f048 663 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0B; cmd[3] = 0x01;
phonemacro 6:e1b7190d6cb5 664 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 1:da792e46a385 665 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 666 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 667 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 668 pc.printf("1.6 Status: %x\n\r", rsp[0]);
phonemacro 13:1baccc6275a7 669 #if AGC
phonemacro 48:6b93b56bb22e 670 // AGC 1.6 Disable auto PD (default
phonemacro 13:1baccc6275a7 671 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x00;
phonemacro 13:1baccc6275a7 672 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 13:1baccc6275a7 673 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 13:1baccc6275a7 674 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 13:1baccc6275a7 675 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 676 pc.printf("AGC1.7 Status: %x\n\r", rsp[0]);
phonemacro 48:6b93b56bb22e 677 // AGC 1.7 Disable SCD (default)
phonemacro 13:1baccc6275a7 678 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x00;
phonemacro 13:1baccc6275a7 679 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 13:1baccc6275a7 680 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 13:1baccc6275a7 681 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 13:1baccc6275a7 682 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 683 pc.printf("AGC1.8 Status: %x\n\r", rsp[0]);
phonemacro 48:6b93b56bb22e 684 // AGC 1.8 Set AGC target PD TO 10uA
phonemacro 13:1baccc6275a7 685 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x11; cmd[3] = 0x00; cmd[3] = 0x64;
phonemacro 13:1baccc6275a7 686 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 13:1baccc6275a7 687 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 13:1baccc6275a7 688 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 13:1baccc6275a7 689 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 690 pc.printf("AGC1.9 Status: %x\n\r", rsp[0]);
phonemacro 13:1baccc6275a7 691 #else
phonemacro 48:6b93b56bb22e 692 // 1.6 enable auto PD (default)
phonemacro 4:4f1e9439f048 693 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x12; cmd[3] = 0x01;
phonemacro 6:e1b7190d6cb5 694 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 1:da792e46a385 695 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 696 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 697 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 698 pc.printf("1.7 Status: %x\n\r", rsp[0]);
phonemacro 48:6b93b56bb22e 699 // 1.7 SCD (default)
phonemacro 4:4f1e9439f048 700 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0C; cmd[3] = 0x01;
phonemacro 6:e1b7190d6cb5 701 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 4:4f1e9439f048 702 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 703 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 4:4f1e9439f048 704 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 705 pc.printf("1.8 Status: %x\n\r", rsp[0]);
phonemacro 13:1baccc6275a7 706 #endif
phonemacro 28:315604f4b374 707
phonemacro 28:315604f4b374 708 #if defined(MAXM86161_CFG) //only use Red and IR
phonemacro 32:92adfbe18ab6 709 //1.20 map leds to slots
phonemacro 28:315604f4b374 710 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x23; cmd[4] = 0x00; cmd[5] = 0x00;
phonemacro 28:315604f4b374 711 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 28:315604f4b374 712 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 713 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 714 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 715 pc.printf("map leds to slots %x\n\r", rsp[0]);
phonemacro 30:77a30ea425da 716 //1.21 map HR inputs to slots, default is 0x0073 for MAXM86161
phonemacro 30:77a30ea425da 717 #if 0 // NA for MAXM86161
phonemacro 28:315604f4b374 718 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x73;
phonemacro 28:315604f4b374 719 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 28:315604f4b374 720 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 721 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 722 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 723 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 30:77a30ea425da 724 #endif
phonemacro 28:315604f4b374 725 //1.22 map SpO2 inputs to slots
phonemacro 28:315604f4b374 726 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x00; cmd[4] = 0x10;
phonemacro 28:315604f4b374 727 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 28:315604f4b374 728 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 729 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 730 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 731 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 732 #endif
phonemacro 28:315604f4b374 733
phonemacro 3:da975696b936 734 #ifdef MAXM86146_CFG
phonemacro 32:92adfbe18ab6 735 //1.20 map leds to slots for MAXM86146
phonemacro 4:4f1e9439f048 736 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x13; cmd[4] = 0x56; cmd[5] = 0x00;
phonemacro 6:e1b7190d6cb5 737 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 3:da975696b936 738 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 739 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 740 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 741 pc.printf("map leds to slots %x\n\r", rsp[0]);
phonemacro 3:da975696b936 742 //1.21 map HR inputs to slots
phonemacro 4:4f1e9439f048 743 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x11;
phonemacro 6:e1b7190d6cb5 744 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 3:da975696b936 745 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 746 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 747 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 748 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 3:da975696b936 749 //1.22 map SpO2 inputs to slots
phonemacro 4:4f1e9439f048 750 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x30; cmd[4] = 0x20;
phonemacro 6:e1b7190d6cb5 751 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 3:da975696b936 752 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 753 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 754 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 755 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 26:33c0d3fd2a95 756
phonemacro 3:da975696b936 757 #if 0
phonemacro 2:563d90a111b3 758 //1.20 Sec 4.1 map leds to slots for MAXM86146
phonemacro 4:4f1e9439f048 759 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x15; cmd[4] = 0x60; cmd[5] = 0x00;
phonemacro 6:e1b7190d6cb5 760 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 1:da792e46a385 761 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 762 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 763 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 764 pc.printf("map leds to slots%x\n\r", rsp[0]);
phonemacro 2:563d90a111b3 765 //1.21 map HR inputs to slots
phonemacro 4:4f1e9439f048 766 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x01;
phonemacro 6:e1b7190d6cb5 767 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 1:da792e46a385 768 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 769 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 770 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 771 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 2:563d90a111b3 772 //1.22 map SpO2 inputs to slots
phonemacro 4:4f1e9439f048 773 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x20; cmd[4] = 0x10;
phonemacro 6:e1b7190d6cb5 774 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 1:da792e46a385 775 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 776 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 1:da792e46a385 777 mfio = 1; mfio = 0; wait_us(300);
phonemacro 3:da975696b936 778 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 3:da975696b936 779 #endif
phonemacro 3:da975696b936 780 #endif // MAXM86146_CFG
phonemacro 0:6f65cae31c54 781
phonemacro 28:315604f4b374 782 #if 0 // MAXM86161 test new commands
phonemacro 28:315604f4b374 783 // LDO enable
phonemacro 28:315604f4b374 784 cmd[0] = 0x10; cmd[1] = 0x12; cmd[2] = 0x01;
phonemacro 28:315604f4b374 785 //cmd[0] = 0x10; cmd[1] = 0x12; cmd[2] = 0x00;
phonemacro 28:315604f4b374 786 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 787 thread_sleep_for(2);
phonemacro 28:315604f4b374 788 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 789 pc.printf("\n\r ldo en %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 790 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 791 // GPIO enable
phonemacro 28:315604f4b374 792 cmd[0] = 0x10; cmd[1] = 0x13; cmd[2] = 0x01;
phonemacro 28:315604f4b374 793 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 794 thread_sleep_for(2);
phonemacro 28:315604f4b374 795 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 796 pc.printf("\n\r gpio en %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 797 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 798 #endif
phonemacro 47:346a13fbdc0f 799 #if 0
phonemacro 47:346a13fbdc0f 800 //write SpO2 coefficients 0x00000000 FFD7FBDD 00AB61FE
phonemacro 47:346a13fbdc0f 801 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x00;
phonemacro 47:346a13fbdc0f 802 cmd[3] = 0x00; cmd[4] = 0x00; cmd[5] = 0x00; cmd[6] = 0x00;
phonemacro 47:346a13fbdc0f 803 cmd[7] = 0xFF; cmd[8] = 0xD7; cmd[9] = 0xFB; cmd[10] = 0xDD;
phonemacro 47:346a13fbdc0f 804 cmd[11] = 0x00; cmd[12] = 0xAB; cmd[13] = 0x61; cmd[14] = 0xFE;
phonemacro 47:346a13fbdc0f 805 sh_i2c.write(SH_ADDR, cmd, 15);
phonemacro 47:346a13fbdc0f 806 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 807 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 47:346a13fbdc0f 808 mfio = 1; mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 809 pc.printf("Wr Spo2 Coeff %x\n\r", rsp[0]);
phonemacro 47:346a13fbdc0f 810 #endif
phonemacro 48:6b93b56bb22e 811 //1.26 rd SpO2 Coefficients
phonemacro 47:346a13fbdc0f 812 cmd[0] = 0x51; cmd[1] = 0x07; cmd[2] = 0x00;
phonemacro 47:346a13fbdc0f 813 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 47:346a13fbdc0f 814 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 815 sh_i2c.read(SH_ADDR, rsp, 13);
phonemacro 47:346a13fbdc0f 816 mfio = 1; mfio = 0; wait_us(300);
phonemacro 47:346a13fbdc0f 817 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 818
phonemacro 32:92adfbe18ab6 819 // 1.30 Enable HR, SpO2 algo
phonemacro 12:17a0bf823462 820 #ifdef EXTENDED_ALGO
phonemacro 12:17a0bf823462 821 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x02;
phonemacro 33:c8fbd904df3e 822 #elif defined(PACKED_NORMAL_ALGO)
phonemacro 33:c8fbd904df3e 823 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x04;
phonemacro 12:17a0bf823462 824 #else
phonemacro 4:4f1e9439f048 825 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x01;
phonemacro 12:17a0bf823462 826 #endif
phonemacro 6:e1b7190d6cb5 827 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 828 mfio = 1;
phonemacro 0:6f65cae31c54 829 thread_sleep_for(465);
phonemacro 28:315604f4b374 830 mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 831 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 3:da975696b936 832 pc.printf("1.14 status: %x\n\r", rsp[0]);
phonemacro 0:6f65cae31c54 833
phonemacro 4:4f1e9439f048 834 #if 1
phonemacro 4:4f1e9439f048 835 //1.31 rd AFE part id
phonemacro 4:4f1e9439f048 836 cmd[0] = 0x41; cmd[1] = 0x00; cmd[2] = 0xFF;
phonemacro 6:e1b7190d6cb5 837 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 4:4f1e9439f048 838 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 839 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 4:4f1e9439f048 840 mfio = 1; mfio = 0; wait_us(300);
phonemacro 4:4f1e9439f048 841 pc.printf("1.31 part id afe %x %x\n\r", rsp[0], rsp[1]);
phonemacro 4:4f1e9439f048 842 //1.32 rd accel who
phonemacro 4:4f1e9439f048 843 cmd[0] = 0x41; cmd[1] = 0x04; cmd[2] = 0x0F;
phonemacro 6:e1b7190d6cb5 844 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 4:4f1e9439f048 845 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 6:e1b7190d6cb5 846 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 4:4f1e9439f048 847 mfio = 1; mfio = 0; wait_us(300);
phonemacro 4:4f1e9439f048 848 pc.printf("1.32 who accel %x %x\n\r", rsp[0], rsp[1]);
phonemacro 28:315604f4b374 849 #endif
phonemacro 52:e5aba237e804 850 // 1.35 spo2 calibration report for data collection
phonemacro 52:e5aba237e804 851 #ifdef SPO2_CAL_RPT
phonemacro 52:e5aba237e804 852 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x0A; cmd[3] = 0x06;
phonemacro 52:e5aba237e804 853 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 52:e5aba237e804 854 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 855 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 52:e5aba237e804 856 mfio = 1; mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 857 pc.printf("1.5 Status: %x\n\r", rsp[0]);
phonemacro 52:e5aba237e804 858 #endif
phonemacro 52:e5aba237e804 859 // rd algo mode
phonemacro 52:e5aba237e804 860 cmd[0] = 0x51; cmd[1] = 0x07; cmd[2] = 0x0A;
phonemacro 52:e5aba237e804 861 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 52:e5aba237e804 862 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 863 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 52:e5aba237e804 864 mfio = 1; mfio = 0; wait_us(300);
phonemacro 52:e5aba237e804 865 pc.printf("algo mode %x %x\n\r", rsp[0], rsp[1]);
phonemacro 52:e5aba237e804 866
phonemacro 26:33c0d3fd2a95 867 mfio = 1;
phonemacro 10:192ea88e964b 868 }
phonemacro 10:192ea88e964b 869
phonemacro 14:c8cc6d7fd5f9 870 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 871 // init_sh_raw
phonemacro 14:c8cc6d7fd5f9 872 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 873 void init_sh_raw(void) {
phonemacro 29:a7dd81450b35 874 char cmd[16];
phonemacro 14:c8cc6d7fd5f9 875 char rsp[256];
phonemacro 14:c8cc6d7fd5f9 876 // switch to application mode
phonemacro 14:c8cc6d7fd5f9 877 rst = 0;
phonemacro 14:c8cc6d7fd5f9 878 mfio = 1;
phonemacro 14:c8cc6d7fd5f9 879 thread_sleep_for(10);
phonemacro 14:c8cc6d7fd5f9 880 rst = 1;
phonemacro 14:c8cc6d7fd5f9 881 thread_sleep_for(1500);
phonemacro 14:c8cc6d7fd5f9 882 #ifdef MAXREFDES103_CFG
phonemacro 14:c8cc6d7fd5f9 883 init_max20303_pmic();
phonemacro 14:c8cc6d7fd5f9 884 #endif
phonemacro 14:c8cc6d7fd5f9 885
phonemacro 14:c8cc6d7fd5f9 886 mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 887
phonemacro 32:92adfbe18ab6 888 //1.0 read operating mode
phonemacro 14:c8cc6d7fd5f9 889 cmd[0] = 0x02; cmd[1] = 0x00;
phonemacro 14:c8cc6d7fd5f9 890 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 14:c8cc6d7fd5f9 891 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 892 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 14:c8cc6d7fd5f9 893 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 894 pc.printf("\n\r 0x02 0x00 Status, Read Operating Mode: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 32:92adfbe18ab6 895 //1.1 rd ver
phonemacro 14:c8cc6d7fd5f9 896 cmd[0] = 0xFF; cmd[1] = 0x03;
phonemacro 14:c8cc6d7fd5f9 897 sh_i2c.write(SH_ADDR, cmd, 2);
phonemacro 14:c8cc6d7fd5f9 898 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 899 sh_i2c.read(SH_ADDR, rsp, 4);
phonemacro 14:c8cc6d7fd5f9 900 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 901 pc.printf("Ver: %d %d %d %d\n\r", rsp[0], rsp[1], rsp[2], rsp[3]);
phonemacro 14:c8cc6d7fd5f9 902
phonemacro 32:92adfbe18ab6 903 // raw1.2 sensor data
phonemacro 14:c8cc6d7fd5f9 904 cmd[0] = 0x10; cmd[1] = 0x00; cmd[2] = 0x01;
phonemacro 14:c8cc6d7fd5f9 905 pc.printf("raw sensor data only \n\r");
phonemacro 14:c8cc6d7fd5f9 906 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 14:c8cc6d7fd5f9 907 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 908 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 909 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 910 pc.printf("raw1.2 Status: %x\n\r", rsp[0]);
phonemacro 32:92adfbe18ab6 911 // raw1.3 interrupt threshold
phonemacro 14:c8cc6d7fd5f9 912 cmd[0] = 0x10; cmd[1] = 0x01; cmd[2] = 0x01;
phonemacro 14:c8cc6d7fd5f9 913 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 14:c8cc6d7fd5f9 914 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 915 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 916 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 917 pc.printf("raw1.3 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 918 #ifdef MAXM86146_CFG
phonemacro 50:dd2f60ab5686 919 //1.20 map leds to slots for MAXM86146
phonemacro 50:dd2f60ab5686 920 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x19; cmd[3] = 0x13; cmd[4] = 0x56; cmd[5] = 0x00;
phonemacro 50:dd2f60ab5686 921 sh_i2c.write(SH_ADDR, cmd, 6);
phonemacro 50:dd2f60ab5686 922 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 923 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 924 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 925 pc.printf("map leds to slots %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 926 //1.21 map HR inputs to slots
phonemacro 50:dd2f60ab5686 927 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x17; cmd[3] = 0x00; cmd[4] = 0x11;
phonemacro 50:dd2f60ab5686 928 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 50:dd2f60ab5686 929 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 930 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 931 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 932 pc.printf("map HR to slots/PDs %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 933 //1.22 map SpO2 inputs to slots
phonemacro 50:dd2f60ab5686 934 cmd[0] = 0x50; cmd[1] = 0x07; cmd[2] = 0x18; cmd[3] = 0x30; cmd[4] = 0x20;
phonemacro 50:dd2f60ab5686 935 sh_i2c.write(SH_ADDR, cmd, 5);
phonemacro 50:dd2f60ab5686 936 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 937 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 938 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 939 pc.printf("map SpO2 to slots/PDs %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 940 #endif
phonemacro 50:dd2f60ab5686 941
phonemacro 50:dd2f60ab5686 942 // raw enable sh accel
phonemacro 14:c8cc6d7fd5f9 943 cmd[0] = 0x44; cmd[1] = 0x04; cmd[2] = 0x01; cmd[3] = 0x00;
phonemacro 14:c8cc6d7fd5f9 944 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 29:a7dd81450b35 945 mfio = 1; thread_sleep_for(20); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 946 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 29:a7dd81450b35 947 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 948 pc.printf("raw1.4 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 949 // raw enable AFE
phonemacro 30:77a30ea425da 950 // cmd[0] = 0x44; cmd[1] = 0x00; cmd[2] = 0x01; cmd[3] = 0x00;
phonemacro 30:77a30ea425da 951 // sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 38:8ff33869be1f 952 cmd[0] = 0x44; cmd[1] = 0x00; cmd[2] = 0x01; // 3 bytes // tested on 33.13.31/12
phonemacro 38:8ff33869be1f 953 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 38:8ff33869be1f 954 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 38:8ff33869be1f 955 sh_i2c.write(SH_ADDR, cmd, 9);
phonemacro 38:8ff33869be1f 956 mfio = 1; thread_sleep_for(465); mfio = 0; wait_us(300);
phonemacro 29:a7dd81450b35 957 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 958 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 959 pc.printf("raw1.6 Status: %x\n\r", rsp[0]);
phonemacro 32:92adfbe18ab6 960
phonemacro 50:dd2f60ab5686 961 /// raw 1.20 AFE part id
phonemacro 50:dd2f60ab5686 962 cmd[0] = 0x41; cmd[1] = 0x00; cmd[2] = 0xFF;
phonemacro 50:dd2f60ab5686 963 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 50:dd2f60ab5686 964 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 965 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 50:dd2f60ab5686 966 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 967 pc.printf("raw1.6 part id Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 50:dd2f60ab5686 968 // raw1.21 rd accel WHO reg
phonemacro 30:77a30ea425da 969 cmd[0] = 0x41; cmd[1] = 0x04; cmd[2] = 0x0F;
phonemacro 30:77a30ea425da 970 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 30:77a30ea425da 971 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 30:77a30ea425da 972 sh_i2c.read(SH_ADDR, rsp, 2);
phonemacro 30:77a30ea425da 973 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 974 pc.printf("1.7 Who Status: %x %x\n\r", rsp[0], rsp[1]);
phonemacro 32:92adfbe18ab6 975
phonemacro 50:dd2f60ab5686 976 // raw1.8 sample rate
phonemacro 50:dd2f60ab5686 977 #if RAW_HZ == 25
phonemacro 50:dd2f60ab5686 978 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x00; // set AFE reg 0x12 to 25 Hz, ave 1
phonemacro 50:dd2f60ab5686 979 #elif RAW_HZ == 50
phonemacro 50:dd2f60ab5686 980 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x40; // set AFE reg 0x12 to 50 Hz
phonemacro 50:dd2f60ab5686 981 #elif RAW_HZ == 100
phonemacro 46:553559610878 982 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x18; // set AFE reg 0x12 to 100 Hz
phonemacro 50:dd2f60ab5686 983 #elif RAW_HZ == 200
phonemacro 50:dd2f60ab5686 984 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x20; // set AFE reg 0x12 to 200 Hz
phonemacro 50:dd2f60ab5686 985 #elif RAW_HZ == 2004
phonemacro 50:dd2f60ab5686 986 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x22; // set AFE reg 0x12 to 200 Hz, ave 4
phonemacro 46:553559610878 987 #else
phonemacro 46:553559610878 988 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x18; // set AFE reg 0x12 to 100 Hz
phonemacro 46:553559610878 989 #endif
phonemacro 14:c8cc6d7fd5f9 990 // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x12; cmd[3] = 0x20; // set AFE reg 0x12 to 200 Hz
phonemacro 14:c8cc6d7fd5f9 991 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 992 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 993 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 994 mfio = 1; mfio = 0; wait_us(300);
phonemacro 32:92adfbe18ab6 995 pc.printf("raw1.8 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 996 // LED1 current
phonemacro 50:dd2f60ab5686 997 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x23; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 998 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 999 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1000 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1001 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1002 pc.printf("LED1 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1003 // LED2 current
phonemacro 50:dd2f60ab5686 1004 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x24; cmd[3] = 0x19;
phonemacro 50:dd2f60ab5686 1005 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 50:dd2f60ab5686 1006 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1007 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 50:dd2f60ab5686 1008 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1009 pc.printf("LED2 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1010 // LED3 current
phonemacro 50:dd2f60ab5686 1011 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x25; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1012 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1013 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1014 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1015 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1016 pc.printf("LED3 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1017 // LED4 current
phonemacro 50:dd2f60ab5686 1018 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x26; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1019 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1020 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1021 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1022 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1023 pc.printf("LED4 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1024 // LED5 current
phonemacro 50:dd2f60ab5686 1025 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x27; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1026 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1027 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1028 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1029 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1030 pc.printf("LED5 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1031 // LED6 current
phonemacro 50:dd2f60ab5686 1032 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x28; cmd[3] = 0x19;
phonemacro 14:c8cc6d7fd5f9 1033 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1034 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1035 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1036 mfio = 1; mfio = 0; wait_us(300);
phonemacro 50:dd2f60ab5686 1037 pc.printf("LED6 Status: %x\n\r", rsp[0]);
phonemacro 50:dd2f60ab5686 1038 #if 0
phonemacro 14:c8cc6d7fd5f9 1039 // Set Seq cntrl1 LED2, LED1
phonemacro 14:c8cc6d7fd5f9 1040 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x20; cmd[3] = 0x21;
phonemacro 14:c8cc6d7fd5f9 1041 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1042 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1043 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1044 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1045 pc.printf("Seq cntrl1 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1046 // Set Seq cntrl2 LED4, LED3
phonemacro 14:c8cc6d7fd5f9 1047 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x21; cmd[3] = 0xA3;
phonemacro 14:c8cc6d7fd5f9 1048 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1049 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1050 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1051 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1052 pc.printf("Seq cntrl2 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1053 // Set Seq cntrl3 LED6, LED5
phonemacro 14:c8cc6d7fd5f9 1054 cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x21;
phonemacro 14:c8cc6d7fd5f9 1055 // cmd[0] = 0x40; cmd[1] = 0x00; cmd[2] = 0x22; cmd[3] = 0x99; // Ambient
phonemacro 14:c8cc6d7fd5f9 1056 sh_i2c.write(SH_ADDR, cmd, 4);
phonemacro 14:c8cc6d7fd5f9 1057 mfio = 1; thread_sleep_for(2); mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1058 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 14:c8cc6d7fd5f9 1059 mfio = 1; mfio = 0; wait_us(300);
phonemacro 14:c8cc6d7fd5f9 1060 pc.printf("Seq cntrl3 Status: %x\n\r", rsp[0]);
phonemacro 14:c8cc6d7fd5f9 1061 #endif
phonemacro 28:315604f4b374 1062 mfio = 1;
phonemacro 28:315604f4b374 1063 }
phonemacro 14:c8cc6d7fd5f9 1064
phonemacro 14:c8cc6d7fd5f9 1065 /*****************************************************************************/
phonemacro 14:c8cc6d7fd5f9 1066 // main
phonemacro 14:c8cc6d7fd5f9 1067 /*****************************************************************************/
phonemacro 10:192ea88e964b 1068 int main()
phonemacro 10:192ea88e964b 1069 {
phonemacro 10:192ea88e964b 1070 sh_i2c.frequency(400000);
phonemacro 10:192ea88e964b 1071 int32_t ledcnt = 0;
phonemacro 10:192ea88e964b 1072 rLED = LED_OFF; gLED = LED_ON; bLED = LED_OFF;
phonemacro 10:192ea88e964b 1073 Ticker ticker; // calls a callback repeatedly with a timeout
phonemacro 28:315604f4b374 1074
phonemacro 28:315604f4b374 1075 #if 0 // test disable algo
phonemacro 28:315604f4b374 1076 char cmd[8];
phonemacro 28:315604f4b374 1077 char rsp[256];
phonemacro 28:315604f4b374 1078 // 3.1 Disable algo
phonemacro 28:315604f4b374 1079 mfio = 1; mfio = 0; wait_us(300);
phonemacro 28:315604f4b374 1080 cmd[0] = 0x52; cmd[1] = 0x07; cmd[2] = 0x00;
phonemacro 28:315604f4b374 1081 sh_i2c.write(SH_ADDR, cmd, 3);
phonemacro 28:315604f4b374 1082 thread_sleep_for(465);
phonemacro 28:315604f4b374 1083 sh_i2c.read(SH_ADDR, rsp, 1);
phonemacro 28:315604f4b374 1084 pc.printf("3.1 disable algo: %x\n\r", rsp[0]);
phonemacro 28:315604f4b374 1085 mfio = 1;
phonemacro 28:315604f4b374 1086 #endif
phonemacro 28:315604f4b374 1087
phonemacro 10:192ea88e964b 1088 //ticker.attach(callback(&blink_timer), BLINKING_RATE_MS); /* set timer for one second */
phonemacro 14:c8cc6d7fd5f9 1089 #ifdef RAW
phonemacro 14:c8cc6d7fd5f9 1090 init_sh_raw();
phonemacro 14:c8cc6d7fd5f9 1091 #else
phonemacro 14:c8cc6d7fd5f9 1092 init_sh_algo();
phonemacro 14:c8cc6d7fd5f9 1093 #endif
phonemacro 28:315604f4b374 1094 mfio = 1;
phonemacro 33:c8fbd904df3e 1095 heading_printed = 0;
phonemacro 8:e6ae69cfecbf 1096 #if defined(MAXREFDES103_CFG) || defined(MAXM86161_CFG) || defined(MAXM86146_CFG)
phonemacro 6:e1b7190d6cb5 1097 Timer tmr1;
phonemacro 0:6f65cae31c54 1098 while (1) {
phonemacro 6:e1b7190d6cb5 1099 tmr1.start();
phonemacro 29:a7dd81450b35 1100 #if defined(RAW)
phonemacro 50:dd2f60ab5686 1101 #if RAW_HZ == 25
phonemacro 50:dd2f60ab5686 1102 if (tmr1.read_ms() >= 40) {
phonemacro 50:dd2f60ab5686 1103 #elif RAW_HZ == 50
phonemacro 50:dd2f60ab5686 1104 if (tmr1.read_ms() >= 20) {
phonemacro 50:dd2f60ab5686 1105 #elif RAW_HZ == 100
phonemacro 29:a7dd81450b35 1106 if (tmr1.read_ms() >= 10) {
phonemacro 50:dd2f60ab5686 1107 #elif RAW_HZ == 200 || RAW_HZ == 2004
phonemacro 50:dd2f60ab5686 1108 if (tmr1.read_ms() >= 5) {
phonemacro 46:553559610878 1109 #else
phonemacro 46:553559610878 1110 if (tmr1.read_ms() >= 10) {
phonemacro 46:553559610878 1111 #endif
phonemacro 29:a7dd81450b35 1112 #else
phonemacro 42:6f980909371f 1113 #ifdef REDUCE_RPT_PERIOD
phonemacro 42:6f980909371f 1114 #ifdef USE_FIFO_BUFFER_CNT
phonemacro 42:6f980909371f 1115 if (tmr1.read_ms() >= 40*REDUCE_RPT_PERIOD*USE_FIFO_BUFFER_CNT) {
phonemacro 42:6f980909371f 1116 #else
phonemacro 42:6f980909371f 1117 if (tmr1.read_ms() >= 40*REDUCE_RPT_PERIOD) {
phonemacro 42:6f980909371f 1118 #endif
phonemacro 42:6f980909371f 1119 #else
phonemacro 42:6f980909371f 1120 #ifdef USE_FIFO_BUFFER_CNT
phonemacro 42:6f980909371f 1121 if (tmr1.read_ms() >= 40*USE_FIFO_BUFFER_CNT) {
phonemacro 42:6f980909371f 1122 #else
phonemacro 28:315604f4b374 1123 if (tmr1.read_ms() >= 40) {
phonemacro 42:6f980909371f 1124 #endif
phonemacro 42:6f980909371f 1125 #endif
phonemacro 29:a7dd81450b35 1126 #endif
phonemacro 7:23b067817ab8 1127 tmr1.reset();
phonemacro 10:192ea88e964b 1128 read_sh_fifo();
phonemacro 7:23b067817ab8 1129 if ((ledcnt++ % 50) == 0)
phonemacro 6:e1b7190d6cb5 1130 gLED = !gLED;
phonemacro 0:6f65cae31c54 1131 }
phonemacro 0:6f65cae31c54 1132 }
phonemacro 6:e1b7190d6cb5 1133 #else
phonemacro 6:e1b7190d6cb5 1134 ticker.attach(callback(&fifo_timer), 0.040f);
phonemacro 6:e1b7190d6cb5 1135 while (1) {
phonemacro 6:e1b7190d6cb5 1136 if (Time_to_Read_PPG) {
phonemacro 10:192ea88e964b 1137 read_sh_fifo();
phonemacro 7:23b067817ab8 1138 if ((ledcnt++ % 50) == 0)
phonemacro 6:e1b7190d6cb5 1139 gLED = !gLED;
phonemacro 6:e1b7190d6cb5 1140 }
phonemacro 6:e1b7190d6cb5 1141 }
phonemacro 6:e1b7190d6cb5 1142 #endif
phonemacro 0:6f65cae31c54 1143 }