David Jung / Mbed OS MAX32664C_MAXM86146_Mode1_Optical

Mode1 Optical Validation

Dependencies:   max32630fthr

main.cpp@42:6f980909371f, 2022-04-08 (annotated)

Committer:
phonemacro
Date:
Fri Apr 08 20:12:45 2022 +0000
Revision:
42:6f980909371f
Parent:
41:950ace6b4ce9
Child:
43:81a5371eeb7e
Add reduced report rate; Add allow samples to accumulate in the fifo before emptying.

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