Maxim Integrated / Mbed OS Host_Software_MAX32664GWEB_HR_wrist

Example Host software for integration of MAX3266x chips (, MAX32664GWEB) equipped with Heart Rate from Wrist Algorithm. This is “stand-alone” software that runs on the MAX32630 low-power microcontroller to display heart rate on the display of the MAXREFDES101 reference design. It is intended provide a simple example of how to initialize and communicate with the sensor hub. Windows and Android communications are not supported.

Dependencies:   Maxim_Sensor_Hub_Communications BMI160 whrmDemoUI max32630hsp3

Fork of Host_Software_MAX32664GWEB_HR_wrist by mehmet gok

SHMAX8614X/SH_Max8614x_BareMetal.cpp@0:ddc2fef69ef9, 2018-12-17 (annotated)

Committer:
gmehmet
Date:
Mon Dec 17 10:34:32 2018 +0300
Revision:
0:ddc2fef69ef9
First Commit New Repo name

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gmehmet 0:ddc2fef69ef9 1 /*******************************************************************************
gmehmet 0:ddc2fef69ef9 2 * Copyright (C) 2018 Maxim Integrated Products, Inc., All Rights Reserved.
gmehmet 0:ddc2fef69ef9 3 *
gmehmet 0:ddc2fef69ef9 4 * Permission is hereby granted, free of charge, to any person obtaining a
gmehmet 0:ddc2fef69ef9 5 * copy of this software and associated documentation files (the "Software"),
gmehmet 0:ddc2fef69ef9 6 * to deal in the Software without restriction, including without limitation
gmehmet 0:ddc2fef69ef9 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
gmehmet 0:ddc2fef69ef9 8 * and/or sell copies of the Software, and to permit persons to whom the
gmehmet 0:ddc2fef69ef9 9 * Software is furnished to do so, subject to the following conditions:
gmehmet 0:ddc2fef69ef9 10 *
gmehmet 0:ddc2fef69ef9 11 * The above copyright notice and this permission notice shall be included
gmehmet 0:ddc2fef69ef9 12 * in all copies or substantial portions of the Software.
gmehmet 0:ddc2fef69ef9 13 *
gmehmet 0:ddc2fef69ef9 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
gmehmet 0:ddc2fef69ef9 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
gmehmet 0:ddc2fef69ef9 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
gmehmet 0:ddc2fef69ef9 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
gmehmet 0:ddc2fef69ef9 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
gmehmet 0:ddc2fef69ef9 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
gmehmet 0:ddc2fef69ef9 20 * OTHER DEALINGS IN THE SOFTWARE.
gmehmet 0:ddc2fef69ef9 21 *
gmehmet 0:ddc2fef69ef9 22 * Except as contained in this notice, the name of Maxim Integrated
gmehmet 0:ddc2fef69ef9 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
gmehmet 0:ddc2fef69ef9 24 * Products, Inc. Branding Policy.
gmehmet 0:ddc2fef69ef9 25 *
gmehmet 0:ddc2fef69ef9 26 * The mere transfer of this software does not imply any licenses
gmehmet 0:ddc2fef69ef9 27 * of trade secrets, proprietary technology, copyrights, patents,
gmehmet 0:ddc2fef69ef9 28 * trademarks, maskwork rights, or any other form of intellectual
gmehmet 0:ddc2fef69ef9 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
gmehmet 0:ddc2fef69ef9 30 * ownership rights.
gmehmet 0:ddc2fef69ef9 31 *******************************************************************************
gmehmet 0:ddc2fef69ef9 32 */
gmehmet 0:ddc2fef69ef9 33 #include "SH_Max8614x_BareMetal.h"
gmehmet 0:ddc2fef69ef9 34 #include "SHComm.h"
gmehmet 0:ddc2fef69ef9 35 #include "HostAccelHelper.h"
gmehmet 0:ddc2fef69ef9 36 #include <string.h> //for memset
gmehmet 0:ddc2fef69ef9 37 #include <stdint.h>
gmehmet 0:ddc2fef69ef9 38
gmehmet 0:ddc2fef69ef9 39 uint16_t HrmResult = 0;
gmehmet 0:ddc2fef69ef9 40 uint16_t SPO2Result = 0;
gmehmet 0:ddc2fef69ef9 41 uint8_t HrmConfidence = 0;
gmehmet 0:ddc2fef69ef9 42 uint8_t SPo2Confidence = 0;
gmehmet 0:ddc2fef69ef9 43
gmehmet 0:ddc2fef69ef9 44
gmehmet 0:ddc2fef69ef9 45
gmehmet 0:ddc2fef69ef9 46 #if defined(DEBUG_INFO)
gmehmet 0:ddc2fef69ef9 47 #define __DBGMESSAGE( str , val ) {printf(str, val);}
gmehmet 0:ddc2fef69ef9 48 #else
gmehmet 0:ddc2fef69ef9 49 #define __DBGMESSAGE( str , val )
gmehmet 0:ddc2fef69ef9 50 #endif
gmehmet 0:ddc2fef69ef9 51
gmehmet 0:ddc2fef69ef9 52
gmehmet 0:ddc2fef69ef9 53 // Defines
gmehmet 0:ddc2fef69ef9 54 #define SSMAX8614X_REG_SIZE 1
gmehmet 0:ddc2fef69ef9 55 #define SSMAX8614X_MODE1_DATASIZE 18 //Taken from API doc
gmehmet 0:ddc2fef69ef9 56 #define SSWHRM_MODE1_DATASIZE 6 //Taken from API doc
gmehmet 0:ddc2fef69ef9 57 #define SSWSPO2_MODE1_DATASIZE 9 // added for wspo2
gmehmet 0:ddc2fef69ef9 58 #define SSACCEL_MODE1_DATASIZE 6 //Taken from API doc
gmehmet 0:ddc2fef69ef9 59 #define SSAGC_MODE1_DATASIZE 0 //Taken from API doc
gmehmet 0:ddc2fef69ef9 60 #define SSBPT_MODE1_2_DATASIZE 4 //Taken from API doc /* TODO */
gmehmet 0:ddc2fef69ef9 61
gmehmet 0:ddc2fef69ef9 62 #define MIN_MACRO(a,b) ((a)<(b)?(a):(b))
gmehmet 0:ddc2fef69ef9 63
gmehmet 0:ddc2fef69ef9 64 // sensor configuration
gmehmet 0:ddc2fef69ef9 65 //#define ENABLE_SENSOR_HUB_ACCEL
gmehmet 0:ddc2fef69ef9 66 #define USE_HOST_ACCEL
gmehmet 0:ddc2fef69ef9 67 // algorithm configuration
gmehmet 0:ddc2fef69ef9 68 #define ENABLE_WHRM_AND_SP02
gmehmet 0:ddc2fef69ef9 69 #define ENABLE_WSP02
gmehmet 0:ddc2fef69ef9 70 // end of senor and algorithm configuration
gmehmet 0:ddc2fef69ef9 71 #define MAX_NUM_WR_ACC_SAMPLES 5
gmehmet 0:ddc2fef69ef9 72 #define BMI160_SAMPLE_RATE 25
gmehmet 0:ddc2fef69ef9 73 // end of defines
gmehmet 0:ddc2fef69ef9 74
gmehmet 0:ddc2fef69ef9 75 //function pointer use to perform arithmetic operation
gmehmet 0:ddc2fef69ef9 76 typedef void (*rx_data_callback)(uint8_t *);
gmehmet 0:ddc2fef69ef9 77 typedef struct {
gmehmet 0:ddc2fef69ef9 78 int data_size;
gmehmet 0:ddc2fef69ef9 79 rx_data_callback rx_data_parser;
gmehmet 0:ddc2fef69ef9 80 } ss_data_req;
gmehmet 0:ddc2fef69ef9 81
gmehmet 0:ddc2fef69ef9 82 typedef struct {
gmehmet 0:ddc2fef69ef9 83 int16_t x;
gmehmet 0:ddc2fef69ef9 84 int16_t y;
gmehmet 0:ddc2fef69ef9 85 int16_t z;
gmehmet 0:ddc2fef69ef9 86 } accel_mode1_data;
gmehmet 0:ddc2fef69ef9 87
gmehmet 0:ddc2fef69ef9 88 typedef struct {
gmehmet 0:ddc2fef69ef9 89 uint32_t led1;
gmehmet 0:ddc2fef69ef9 90 uint32_t led2;
gmehmet 0:ddc2fef69ef9 91 uint32_t led3;
gmehmet 0:ddc2fef69ef9 92 uint32_t led4;
gmehmet 0:ddc2fef69ef9 93 uint32_t led5;
gmehmet 0:ddc2fef69ef9 94 uint32_t led6;
gmehmet 0:ddc2fef69ef9 95 } max8614x_mode1_data;
gmehmet 0:ddc2fef69ef9 96
gmehmet 0:ddc2fef69ef9 97 typedef struct {
gmehmet 0:ddc2fef69ef9 98 uint16_t hr;
gmehmet 0:ddc2fef69ef9 99 uint8_t hr_conf;
gmehmet 0:ddc2fef69ef9 100 uint16_t spo2;
gmehmet 0:ddc2fef69ef9 101 uint8_t status;
gmehmet 0:ddc2fef69ef9 102 } whrm_mode1_data;
gmehmet 0:ddc2fef69ef9 103
gmehmet 0:ddc2fef69ef9 104
gmehmet 0:ddc2fef69ef9 105 typedef struct { /// added for WSPO2
gmehmet 0:ddc2fef69ef9 106 uint16_t r;
gmehmet 0:ddc2fef69ef9 107 uint8_t spo2_conf;
gmehmet 0:ddc2fef69ef9 108 uint16_t spo2;
gmehmet 0:ddc2fef69ef9 109 uint8_t percentComplete;
gmehmet 0:ddc2fef69ef9 110 uint8_t lowSignalQualityFlag;
gmehmet 0:ddc2fef69ef9 111 uint8_t motionFlag;
gmehmet 0:ddc2fef69ef9 112 uint8_t status; //isSpo2Calculated;
gmehmet 0:ddc2fef69ef9 113 } wspo2_mode1_data;
gmehmet 0:ddc2fef69ef9 114
gmehmet 0:ddc2fef69ef9 115 typedef struct Max86140_SH_Status_Tracker {
gmehmet 0:ddc2fef69ef9 116 uint8_t sensor_data_from_host;
gmehmet 0:ddc2fef69ef9 117 uint8_t data_type_enabled; // what type of data is enabled
gmehmet 0:ddc2fef69ef9 118 uint8_t sample_count_enabled; // does me11 provide sample count
gmehmet 0:ddc2fef69ef9 119 uint32_t sample_count;
gmehmet 0:ddc2fef69ef9 120 uint8_t data_buf_storage[512]; // store data read from SH
gmehmet 0:ddc2fef69ef9 121 ss_data_req algo_callbacks[SH_NUM_CURRENT_ALGOS];
gmehmet 0:ddc2fef69ef9 122 ss_data_req sensor_callbacks[SH_NUM_CURRENT_SENSORS];
gmehmet 0:ddc2fef69ef9 123 uint8_t sensor_enabled_mode[SH_NUM_CURRENT_SENSORS];
gmehmet 0:ddc2fef69ef9 124 uint8_t algo_enabled_mode[SH_NUM_CURRENT_ALGOS];
gmehmet 0:ddc2fef69ef9 125 int input_fifo_size;
gmehmet 0:ddc2fef69ef9 126 } Max86140_SH_Status_Tracker_t;
gmehmet 0:ddc2fef69ef9 127
gmehmet 0:ddc2fef69ef9 128 // Max8614x Default Callbacks
gmehmet 0:ddc2fef69ef9 129 void max8614x_data_rx(uint8_t* data_ptr)
gmehmet 0:ddc2fef69ef9 130 {
gmehmet 0:ddc2fef69ef9 131 max8614x_mode1_data sample;
gmehmet 0:ddc2fef69ef9 132 sample.led1 = (data_ptr[0] << 16) | (data_ptr[1] << 8) | data_ptr[2];
gmehmet 0:ddc2fef69ef9 133 sample.led2 = (data_ptr[3] << 16) | (data_ptr[4] << 8) | data_ptr[5];
gmehmet 0:ddc2fef69ef9 134 sample.led3 = (data_ptr[6] << 16) | (data_ptr[7] << 8) | data_ptr[8];
gmehmet 0:ddc2fef69ef9 135 sample.led4 = (data_ptr[9] << 16) | (data_ptr[10] << 8) | data_ptr[11];
gmehmet 0:ddc2fef69ef9 136 sample.led5 = (data_ptr[12] << 16) | (data_ptr[13] << 8) | data_ptr[14];
gmehmet 0:ddc2fef69ef9 137 sample.led6 = (data_ptr[15] << 16) | (data_ptr[16] << 8) | data_ptr[17];
gmehmet 0:ddc2fef69ef9 138
gmehmet 0:ddc2fef69ef9 139 //printf("led1=%.6X led2=%.6X led3=%.6X led4=%.6X led5=%.6X led6=%.6X\r\n",
gmehmet 0:ddc2fef69ef9 140 // sample.led1, sample.led2, sample.led3, sample.led4, sample.led5, sample.led6);
gmehmet 0:ddc2fef69ef9 141
gmehmet 0:ddc2fef69ef9 142 //enqueue(&max8614x_queue, &sample);
gmehmet 0:ddc2fef69ef9 143 }
gmehmet 0:ddc2fef69ef9 144 void whrm_data_rx(uint8_t* data_ptr) {
gmehmet 0:ddc2fef69ef9 145 //See API doc for data format
gmehmet 0:ddc2fef69ef9 146 whrm_mode1_data sample;
gmehmet 0:ddc2fef69ef9 147 sample.hr = (data_ptr[0] << 8) | data_ptr[1];
gmehmet 0:ddc2fef69ef9 148 sample.hr_conf = data_ptr[2];
gmehmet 0:ddc2fef69ef9 149 sample.spo2 = (data_ptr[3] << 8) | data_ptr[4];
gmehmet 0:ddc2fef69ef9 150 sample.status = data_ptr[5];
gmehmet 0:ddc2fef69ef9 151 HrmResult = sample.hr / 10;
gmehmet 0:ddc2fef69ef9 152 HrmConfidence = sample.hr_conf;
gmehmet 0:ddc2fef69ef9 153 //printf("hr_c=%d\r\n", HrmResult);
gmehmet 0:ddc2fef69ef9 154 #if defined(DEBUG_INFO)
gmehmet 0:ddc2fef69ef9 155 printf("hr=%.1f conf=%d spo2=%d status=%d\r\n", (float)sample.hr / 10.0, sample.hr_conf, sample.spo2, sample.status);
gmehmet 0:ddc2fef69ef9 156 #endif
gmehmet 0:ddc2fef69ef9 157 //enqueue(&whrm_queue, &sample);
gmehmet 0:ddc2fef69ef9 158 }
gmehmet 0:ddc2fef69ef9 159
gmehmet 0:ddc2fef69ef9 160 void wspo2_data_rx(uint8_t* data_ptr)
gmehmet 0:ddc2fef69ef9 161 {
gmehmet 0:ddc2fef69ef9 162 //See API doc for data format
gmehmet 0:ddc2fef69ef9 163 wspo2_mode1_data sample;
gmehmet 0:ddc2fef69ef9 164 sample.r = (data_ptr[0] << 8) | data_ptr[1]; // already x10
gmehmet 0:ddc2fef69ef9 165 sample.spo2_conf = data_ptr[2];
gmehmet 0:ddc2fef69ef9 166 sample.spo2 = (data_ptr[3] << 8) | data_ptr[4]; // already x10
gmehmet 0:ddc2fef69ef9 167 sample.percentComplete = data_ptr[5];
gmehmet 0:ddc2fef69ef9 168 sample.lowSignalQualityFlag = data_ptr[6];
gmehmet 0:ddc2fef69ef9 169 sample.motionFlag = data_ptr[7];
gmehmet 0:ddc2fef69ef9 170 sample.status = data_ptr[8];
gmehmet 0:ddc2fef69ef9 171 SPO2Result = sample.spo2 / 10;
gmehmet 0:ddc2fef69ef9 172 SPo2Confidence = sample.spo2_conf;
gmehmet 0:ddc2fef69ef9 173 #if defined(DEBUG_INFO)
gmehmet 0:ddc2fef69ef9 174 printf("r=%.1f SpO2Conf=%d SpO2=%.1f prcntComp=%d lowSig=%d motion=%d isCalc=%d\r\n", (float)sample.r / 10.0, sample.spo2_conf, (float)sample.spo2/10.0, sample.percentComplete, sample.lowSignalQualityFlag , sample.motionFlag, sample.status);
gmehmet 0:ddc2fef69ef9 175 #endif
gmehmet 0:ddc2fef69ef9 176 //enqueue(&wspo2_queue, &sample);
gmehmet 0:ddc2fef69ef9 177 }
gmehmet 0:ddc2fef69ef9 178
gmehmet 0:ddc2fef69ef9 179 void accel_data_rx(uint8_t* data_ptr) {
gmehmet 0:ddc2fef69ef9 180 //See API doc for data format
gmehmet 0:ddc2fef69ef9 181 accel_mode1_data sample;
gmehmet 0:ddc2fef69ef9 182 sample.x = (data_ptr[0] << 8) | data_ptr[1];
gmehmet 0:ddc2fef69ef9 183 sample.y = (data_ptr[2] << 8) | data_ptr[3];
gmehmet 0:ddc2fef69ef9 184 sample.z = (data_ptr[4] << 8) | data_ptr[5];
gmehmet 0:ddc2fef69ef9 185 //printf("x:%d, y:%d, z:%d\r\n", sample.x, sample.y, sample.z);
gmehmet 0:ddc2fef69ef9 186 }
gmehmet 0:ddc2fef69ef9 187
gmehmet 0:ddc2fef69ef9 188 void agc_data_rx(uint8_t* data_ptr) {
gmehmet 0:ddc2fef69ef9 189 //NOP: AGC does not collect data
gmehmet 0:ddc2fef69ef9 190 }
gmehmet 0:ddc2fef69ef9 191 // end of Max8614x Default Callbacks
gmehmet 0:ddc2fef69ef9 192
gmehmet 0:ddc2fef69ef9 193
gmehmet 0:ddc2fef69ef9 194 static Max86140_SH_Status_Tracker * get_config_struct() {
gmehmet 0:ddc2fef69ef9 195
gmehmet 0:ddc2fef69ef9 196 /* assigns a static adress to configuration struct*/
gmehmet 0:ddc2fef69ef9 197 static Max86140_SH_Status_Tracker glbl_max8614x_status_track;
gmehmet 0:ddc2fef69ef9 198 return &glbl_max8614x_status_track;
gmehmet 0:ddc2fef69ef9 199 }
gmehmet 0:ddc2fef69ef9 200
gmehmet 0:ddc2fef69ef9 201 void initialize_config_struct() {
gmehmet 0:ddc2fef69ef9 202 Max86140_SH_Status_Tracker *p_glbl_max8614x_status_track = get_config_struct();
gmehmet 0:ddc2fef69ef9 203 /*
gmehmet 0:ddc2fef69ef9 204 * Desc: Configuration init flow, Perform this action at init stage of data acquisition. Raw sesnsor data buffer pointer is input to each
gmehmet 0:ddc2fef69ef9 205 * enabled sensor/algorithm,s funtion that is responsible to extract numeric data from data byte stream from sensor hub.
gmehmet 0:ddc2fef69ef9 206 *
gmehmet 0:ddc2fef69ef9 207 * - Append Sensor Raw Data structure with raw sensor data sample size and pointer to function of sensor that is reposible to parse
gmehmet 0:ddc2fef69ef9 208 * data byte stream from sesnor hub and extract sensor numeric data.
gmehmet 0:ddc2fef69ef9 209 * - Append accompanying sensors to main state of sensor. ie Accelerometer from Host with sensor data sample size and pointer to function of
gmehmet 0:ddc2fef69ef9 210 * sensor that is reposible to parse data byte stream from sesnor hub and extract sensor numeric data.
gmehmet 0:ddc2fef69ef9 211 * - Append algorithms to be enabled with algorithm data sample size and pointer to function of
gmehmet 0:ddc2fef69ef9 212 * algorithm that is reposible to parse data byte stream from sensor hub and extract sensor numeric data.
gmehmet 0:ddc2fef69ef9 213 *
gmehmet 0:ddc2fef69ef9 214 * */
gmehmet 0:ddc2fef69ef9 215
gmehmet 0:ddc2fef69ef9 216 //set all the values to 0
gmehmet 0:ddc2fef69ef9 217 memset(p_glbl_max8614x_status_track, 0, sizeof(*p_glbl_max8614x_status_track));
gmehmet 0:ddc2fef69ef9 218 // max8614x
gmehmet 0:ddc2fef69ef9 219 p_glbl_max8614x_status_track->sensor_callbacks[SH_SENSORIDX_MAX8614X].data_size = SSMAX8614X_MODE1_DATASIZE;
gmehmet 0:ddc2fef69ef9 220 p_glbl_max8614x_status_track->sensor_callbacks[SH_SENSORIDX_MAX8614X].rx_data_parser = &max8614x_data_rx;
gmehmet 0:ddc2fef69ef9 221 // accelerometer
gmehmet 0:ddc2fef69ef9 222 p_glbl_max8614x_status_track->sensor_callbacks[SH_SENSORIDX_ACCEL].data_size = SSACCEL_MODE1_DATASIZE;
gmehmet 0:ddc2fef69ef9 223 p_glbl_max8614x_status_track->sensor_callbacks[SH_SENSORIDX_ACCEL].rx_data_parser = &accel_data_rx;
gmehmet 0:ddc2fef69ef9 224 // agc
gmehmet 0:ddc2fef69ef9 225 p_glbl_max8614x_status_track->algo_callbacks[SH_ALGOIDX_AGC].data_size = SSAGC_MODE1_DATASIZE;
gmehmet 0:ddc2fef69ef9 226 p_glbl_max8614x_status_track->algo_callbacks[SH_ALGOIDX_AGC].rx_data_parser = &agc_data_rx;
gmehmet 0:ddc2fef69ef9 227 // whrm
gmehmet 0:ddc2fef69ef9 228 p_glbl_max8614x_status_track->algo_callbacks[SH_ALGOIDX_WHRM].data_size = SSWHRM_MODE1_DATASIZE;
gmehmet 0:ddc2fef69ef9 229 p_glbl_max8614x_status_track->algo_callbacks[SH_ALGOIDX_WHRM].rx_data_parser = &whrm_data_rx;
gmehmet 0:ddc2fef69ef9 230 // spo2
gmehmet 0:ddc2fef69ef9 231 p_glbl_max8614x_status_track->algo_callbacks[SH_ALGOIDX_WSPO2].data_size = SSWSPO2_MODE1_DATASIZE;
gmehmet 0:ddc2fef69ef9 232 p_glbl_max8614x_status_track->algo_callbacks[SH_ALGOIDX_WSPO2].rx_data_parser = &wspo2_data_rx;
gmehmet 0:ddc2fef69ef9 233 }
gmehmet 0:ddc2fef69ef9 234
gmehmet 0:ddc2fef69ef9 235
gmehmet 0:ddc2fef69ef9 236 void SH_Max8614x_get_reg(uint8_t addr, uint32_t *val) {
gmehmet 0:ddc2fef69ef9 237 int status = sh_get_reg(SH_SENSORIDX_MAX8614X, addr, val);
gmehmet 0:ddc2fef69ef9 238
gmehmet 0:ddc2fef69ef9 239 if (status == 0) {
gmehmet 0:ddc2fef69ef9 240 __DBGMESSAGE("\r\n reg_val=%02X err=0 \r\n", ((uint8_t)*val))
gmehmet 0:ddc2fef69ef9 241 } else {
gmehmet 0:ddc2fef69ef9 242 __DBGMESSAGE("\r\n err=%d\r\n", -1)
gmehmet 0:ddc2fef69ef9 243 }
gmehmet 0:ddc2fef69ef9 244
gmehmet 0:ddc2fef69ef9 245 return;
gmehmet 0:ddc2fef69ef9 246 }
gmehmet 0:ddc2fef69ef9 247
gmehmet 0:ddc2fef69ef9 248 int CSTMR_SH_FeedAccDataIntoSH(Max86140_SH_Status_Tracker_t *p_max8614x_status_track) {
gmehmet 0:ddc2fef69ef9 249 static accel_data_t peek_buf[MAX_NUM_WR_ACC_SAMPLES];
gmehmet 0:ddc2fef69ef9 250 static uint8_t tx_buf[MAX_NUM_WR_ACC_SAMPLES * sizeof(accel_mode1_data) + 2]; // 2 bytes for the command
gmehmet 0:ddc2fef69ef9 251 if(!p_max8614x_status_track->sensor_data_from_host) {
gmehmet 0:ddc2fef69ef9 252 return -1;
gmehmet 0:ddc2fef69ef9 253 } else {
gmehmet 0:ddc2fef69ef9 254 accel_data_t accel_data = {0};
gmehmet 0:ddc2fef69ef9 255 accel_mode1_data acc_sample;
gmehmet 0:ddc2fef69ef9 256 int num_tx, num_samples, num_bytes = 0, num_wr_bytes = 0;
gmehmet 0:ddc2fef69ef9 257 int num_written_samples, nb_expected;
gmehmet 0:ddc2fef69ef9 258 int ret = 0;
gmehmet 0:ddc2fef69ef9 259
gmehmet 0:ddc2fef69ef9 260 // get accelerometer data
gmehmet 0:ddc2fef69ef9 261 ret = CSTMR_SH_HostAccelerometerGet_sensor_xyz(&accel_data);
gmehmet 0:ddc2fef69ef9 262 if (ret < 0)
gmehmet 0:ddc2fef69ef9 263 return ret;
gmehmet 0:ddc2fef69ef9 264
gmehmet 0:ddc2fef69ef9 265 if(CSTMR_SH_HostAccelerometerEnqueueData(&accel_data) != 0) {
gmehmet 0:ddc2fef69ef9 266 __DBGMESSAGE("Thrown an accel sample\n", NULL)
gmehmet 0:ddc2fef69ef9 267 }
gmehmet 0:ddc2fef69ef9 268
gmehmet 0:ddc2fef69ef9 269 if(CSTMR_SH_HostAccelerometerGetDataCount() < MAX_NUM_WR_ACC_SAMPLES) {
gmehmet 0:ddc2fef69ef9 270 return -1;
gmehmet 0:ddc2fef69ef9 271 }
gmehmet 0:ddc2fef69ef9 272
gmehmet 0:ddc2fef69ef9 273 ret = sh_get_num_bytes_in_input_fifo(&num_bytes);
gmehmet 0:ddc2fef69ef9 274 if (ret != 0) {
gmehmet 0:ddc2fef69ef9 275 __DBGMESSAGE("Unable to read num bytes in input fifo\r\n", NULL)
gmehmet 0:ddc2fef69ef9 276 return -1;
gmehmet 0:ddc2fef69ef9 277 }
gmehmet 0:ddc2fef69ef9 278 num_tx = p_max8614x_status_track->input_fifo_size - num_bytes;
gmehmet 0:ddc2fef69ef9 279 if (num_tx <= 0) {
gmehmet 0:ddc2fef69ef9 280 __DBGMESSAGE("num_tx can't be negative\r\n",NULL)
gmehmet 0:ddc2fef69ef9 281 return -1;
gmehmet 0:ddc2fef69ef9 282 }
gmehmet 0:ddc2fef69ef9 283 num_samples = num_tx / sizeof(accel_mode1_data);
gmehmet 0:ddc2fef69ef9 284 num_samples = MIN_MACRO(num_samples, MAX_NUM_WR_ACC_SAMPLES);
gmehmet 0:ddc2fef69ef9 285 num_tx = num_samples * sizeof(accel_mode1_data);
gmehmet 0:ddc2fef69ef9 286 if (num_samples == 0) {
gmehmet 0:ddc2fef69ef9 287 __DBGMESSAGE("Input FIFO is Full\r\n",NULL)
gmehmet 0:ddc2fef69ef9 288 return -1;
gmehmet 0:ddc2fef69ef9 289 }
gmehmet 0:ddc2fef69ef9 290
gmehmet 0:ddc2fef69ef9 291 for(int i = 0; i < num_samples; ++i) {
gmehmet 0:ddc2fef69ef9 292 ret |= CSTMR_SH_HostAccelerometerDequeuData(&peek_buf[i]);
gmehmet 0:ddc2fef69ef9 293 }
gmehmet 0:ddc2fef69ef9 294 if (ret != 0) {
gmehmet 0:ddc2fef69ef9 295 __DBGMESSAGE("CSTMR_SH_HostAccelerometerDequeuData failed\r\n",NULL)
gmehmet 0:ddc2fef69ef9 296 return -1;
gmehmet 0:ddc2fef69ef9 297 }
gmehmet 0:ddc2fef69ef9 298
gmehmet 0:ddc2fef69ef9 299
gmehmet 0:ddc2fef69ef9 300 for (int i = 2, j = 0; j < num_samples; i+= sizeof(accel_mode1_data), j++) {
gmehmet 0:ddc2fef69ef9 301 accel_data = peek_buf[j];
gmehmet 0:ddc2fef69ef9 302 acc_sample.x = (int16_t)(accel_data.x*1000);
gmehmet 0:ddc2fef69ef9 303 acc_sample.y = (int16_t)(accel_data.y*1000);
gmehmet 0:ddc2fef69ef9 304 acc_sample.z = (int16_t)(accel_data.z*1000);
gmehmet 0:ddc2fef69ef9 305 tx_buf[i] = acc_sample.x;
gmehmet 0:ddc2fef69ef9 306 tx_buf[i + 1] = acc_sample.x >> 8;
gmehmet 0:ddc2fef69ef9 307 tx_buf[i + 2] = acc_sample.y;
gmehmet 0:ddc2fef69ef9 308 tx_buf[i + 3] = acc_sample.y >> 8;
gmehmet 0:ddc2fef69ef9 309 tx_buf[i + 4] = acc_sample.z;
gmehmet 0:ddc2fef69ef9 310 tx_buf[i + 5] = acc_sample.z >> 8;
gmehmet 0:ddc2fef69ef9 311
gmehmet 0:ddc2fef69ef9 312 }
gmehmet 0:ddc2fef69ef9 313
gmehmet 0:ddc2fef69ef9 314 ret = sh_feed_to_input_fifo(tx_buf, num_tx + 2, &num_wr_bytes);
gmehmet 0:ddc2fef69ef9 315 if(ret != 0) {
gmehmet 0:ddc2fef69ef9 316 __DBGMESSAGE("sh_feed_to_input_fifo\r\n",NULL)
gmehmet 0:ddc2fef69ef9 317 return -1;
gmehmet 0:ddc2fef69ef9 318 }
gmehmet 0:ddc2fef69ef9 319 num_written_samples = num_wr_bytes / sizeof(accel_mode1_data);
gmehmet 0:ddc2fef69ef9 320 if(num_written_samples != num_samples) {
gmehmet 0:ddc2fef69ef9 321 __DBGMESSAGE("num_written_samples failed\r\n",NULL)
gmehmet 0:ddc2fef69ef9 322 return -1;
gmehmet 0:ddc2fef69ef9 323 }
gmehmet 0:ddc2fef69ef9 324 }
gmehmet 0:ddc2fef69ef9 325 return 0;
gmehmet 0:ddc2fef69ef9 326 }
gmehmet 0:ddc2fef69ef9 327
gmehmet 0:ddc2fef69ef9 328
gmehmet 0:ddc2fef69ef9 329 void SH_Max8614x_set_reg(uint8_t addr, uint32_t val) {
gmehmet 0:ddc2fef69ef9 330 int status;
gmehmet 0:ddc2fef69ef9 331 status = sh_set_reg(SH_SENSORIDX_MAX8614X, addr, val, SSMAX8614X_REG_SIZE);
gmehmet 0:ddc2fef69ef9 332 __DBGMESSAGE("\r\n err=%d\r\n", status);
gmehmet 0:ddc2fef69ef9 333 }
gmehmet 0:ddc2fef69ef9 334
gmehmet 0:ddc2fef69ef9 335
gmehmet 0:ddc2fef69ef9 336
gmehmet 0:ddc2fef69ef9 337 int SH_Max8614x_data_report_execute(void) {
gmehmet 0:ddc2fef69ef9 338
gmehmet 0:ddc2fef69ef9 339 int num_samples, databufLen;
gmehmet 0:ddc2fef69ef9 340 uint8_t *databuf;
gmehmet 0:ddc2fef69ef9 341
gmehmet 0:ddc2fef69ef9 342
gmehmet 0:ddc2fef69ef9 343 Max86140_SH_Status_Tracker_t *p_glbl_max8614x_status_track = get_config_struct();
gmehmet 0:ddc2fef69ef9 344
gmehmet 0:ddc2fef69ef9 345 // prepare the buffer to store the results
gmehmet 0:ddc2fef69ef9 346 databuf = p_glbl_max8614x_status_track->data_buf_storage;
gmehmet 0:ddc2fef69ef9 347 databufLen = sizeof(p_glbl_max8614x_status_track->data_buf_storage);
gmehmet 0:ddc2fef69ef9 348
gmehmet 0:ddc2fef69ef9 349 // poll SH
gmehmet 0:ddc2fef69ef9 350 sh_ss_execute_once(databuf, databufLen, &num_samples);
gmehmet 0:ddc2fef69ef9 351
gmehmet 0:ddc2fef69ef9 352 // feed accelerometer into me11
gmehmet 0:ddc2fef69ef9 353 CSTMR_SH_FeedAccDataIntoSH(p_glbl_max8614x_status_track);
gmehmet 0:ddc2fef69ef9 354
gmehmet 0:ddc2fef69ef9 355 if(num_samples) {
gmehmet 0:ddc2fef69ef9 356 //Skip status byte
gmehmet 0:ddc2fef69ef9 357 uint8_t *data_ptr = &databuf[1];
gmehmet 0:ddc2fef69ef9 358
gmehmet 0:ddc2fef69ef9 359 int i = 0;
gmehmet 0:ddc2fef69ef9 360 for (i = 0; i < num_samples; i++) {
gmehmet 0:ddc2fef69ef9 361 int sh_data_type = p_glbl_max8614x_status_track->data_type_enabled;
gmehmet 0:ddc2fef69ef9 362 if (p_glbl_max8614x_status_track->sample_count_enabled) {
gmehmet 0:ddc2fef69ef9 363 p_glbl_max8614x_status_track->sample_count = *data_ptr++;
gmehmet 0:ddc2fef69ef9 364 }
gmehmet 0:ddc2fef69ef9 365 //Chop up data and send to modules with enabled sensors
gmehmet 0:ddc2fef69ef9 366 if (sh_data_type == SS_DATATYPE_RAW || sh_data_type == SS_DATATYPE_BOTH) {
gmehmet 0:ddc2fef69ef9 367 for (int i = 0; i < SH_NUM_CURRENT_SENSORS; i++) {
gmehmet 0:ddc2fef69ef9 368 if (p_glbl_max8614x_status_track->sensor_enabled_mode[i]) {
gmehmet 0:ddc2fef69ef9 369 p_glbl_max8614x_status_track->sensor_callbacks[i].rx_data_parser(data_ptr);
gmehmet 0:ddc2fef69ef9 370 data_ptr += p_glbl_max8614x_status_track->sensor_callbacks[i].data_size;
gmehmet 0:ddc2fef69ef9 371 }
gmehmet 0:ddc2fef69ef9 372 }
gmehmet 0:ddc2fef69ef9 373 }
gmehmet 0:ddc2fef69ef9 374 if (sh_data_type == SS_DATATYPE_ALGO || sh_data_type == SS_DATATYPE_BOTH) {
gmehmet 0:ddc2fef69ef9 375 for (int i = 0; i < SH_NUM_CURRENT_ALGOS; i++) {
gmehmet 0:ddc2fef69ef9 376 if (p_glbl_max8614x_status_track->algo_enabled_mode[i]) {
gmehmet 0:ddc2fef69ef9 377 p_glbl_max8614x_status_track->algo_callbacks[i].rx_data_parser(data_ptr);
gmehmet 0:ddc2fef69ef9 378 data_ptr += p_glbl_max8614x_status_track->algo_callbacks[i].data_size;
gmehmet 0:ddc2fef69ef9 379 }
gmehmet 0:ddc2fef69ef9 380 }
gmehmet 0:ddc2fef69ef9 381 }
gmehmet 0:ddc2fef69ef9 382 }
gmehmet 0:ddc2fef69ef9 383 }
gmehmet 0:ddc2fef69ef9 384 return num_samples;
gmehmet 0:ddc2fef69ef9 385 }
gmehmet 0:ddc2fef69ef9 386
gmehmet 0:ddc2fef69ef9 387 int SH_Max8614x_algo_init(enum enAlgoMode paramAlgoMode) {
gmehmet 0:ddc2fef69ef9 388
gmehmet 0:ddc2fef69ef9 389 /*
gmehmet 0:ddc2fef69ef9 390 *
gmehmet 0:ddc2fef69ef9 391 * */
gmehmet 0:ddc2fef69ef9 392 int status;
gmehmet 0:ddc2fef69ef9 393 Max86140_SH_Status_Tracker_t *p_glbl_max8614x_status_track = get_config_struct();
gmehmet 0:ddc2fef69ef9 394 if(p_glbl_max8614x_status_track->algo_enabled_mode[SH_ALGOIDX_WHRM] ||
gmehmet 0:ddc2fef69ef9 395 p_glbl_max8614x_status_track->algo_enabled_mode[SH_ALGOIDX_WSPO2]) {
gmehmet 0:ddc2fef69ef9 396 __DBGMESSAGE("\r\n Algo already enabled\r\n",NULL)
gmehmet 0:ddc2fef69ef9 397 return -1;
gmehmet 0:ddc2fef69ef9 398 }
gmehmet 0:ddc2fef69ef9 399
gmehmet 0:ddc2fef69ef9 400 if(paramAlgoMode == kAlgoModeHeartRate) {
gmehmet 0:ddc2fef69ef9 401 status = sh_enable_algo(SH_ALGOIDX_WHRM, SSWHRM_MODE1_DATASIZE);
gmehmet 0:ddc2fef69ef9 402 if (status != SS_SUCCESS) {
gmehmet 0:ddc2fef69ef9 403 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 404 __DBGMESSAGE("FAILED at line %d, enable whrm\n", __LINE__)
gmehmet 0:ddc2fef69ef9 405 return status;
gmehmet 0:ddc2fef69ef9 406 }
gmehmet 0:ddc2fef69ef9 407 p_glbl_max8614x_status_track->algo_enabled_mode[SH_ALGOIDX_WHRM] = 0x01;
gmehmet 0:ddc2fef69ef9 408 } else {
gmehmet 0:ddc2fef69ef9 409 status = sh_enable_algo(SH_ALGOIDX_WSPO2, SSWSPO2_MODE1_DATASIZE);
gmehmet 0:ddc2fef69ef9 410 if (status != SS_SUCCESS) {
gmehmet 0:ddc2fef69ef9 411 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 412 __DBGMESSAGE("FAILED at line %d, enable whrm\n", __LINE__)
gmehmet 0:ddc2fef69ef9 413 return status;
gmehmet 0:ddc2fef69ef9 414 }
gmehmet 0:ddc2fef69ef9 415 p_glbl_max8614x_status_track->algo_enabled_mode[SH_ALGOIDX_WSPO2] = 0x01;
gmehmet 0:ddc2fef69ef9 416 }
gmehmet 0:ddc2fef69ef9 417 }
gmehmet 0:ddc2fef69ef9 418
gmehmet 0:ddc2fef69ef9 419
gmehmet 0:ddc2fef69ef9 420 int SH_Max8614x_default_init(enum enAlgoMode paramAlgoMode) {
gmehmet 0:ddc2fef69ef9 421 /*
gmehmet 0:ddc2fef69ef9 422 * Desc: Initialization flow to get algorithm estimation results:
gmehmet 0:ddc2fef69ef9 423 * 1. initialize algorithm config struct
gmehmet 0:ddc2fef69ef9 424 * 2. enable data type to both raw sensor and algorithm data
gmehmet 0:ddc2fef69ef9 425 * 3. get input fifo size to learn fifo capacity
gmehmet 0:ddc2fef69ef9 426 * 4. set fifo threshold for mfio event frequency
gmehmet 0:ddc2fef69ef9 427 * 5. enable sensor to acquire ppg data
gmehmet 0:ddc2fef69ef9 428 * 6. enable accompanying accel sensor
gmehmet 0:ddc2fef69ef9 429 * 7. enable algorithm
gmehmet 0:ddc2fef69ef9 430 * 8. Sensor Hub now starts to write raw sensor/algorithm data to its data report FIFO which
gmehmet 0:ddc2fef69ef9 431 * reports mfio event when data size determined by fifo threshold is written to report fifo
gmehmet 0:ddc2fef69ef9 432 * data can be read by SH_Max8614x_data_report_execute function.
gmehmet 0:ddc2fef69ef9 433 *
gmehmet 0:ddc2fef69ef9 434 * */
gmehmet 0:ddc2fef69ef9 435
gmehmet 0:ddc2fef69ef9 436 int status;
gmehmet 0:ddc2fef69ef9 437
gmehmet 0:ddc2fef69ef9 438 // first initialize the global config struct
gmehmet 0:ddc2fef69ef9 439 initialize_config_struct();
gmehmet 0:ddc2fef69ef9 440 Max86140_SH_Status_Tracker_t *p_glbl_max8614x_status_track = get_config_struct();
gmehmet 0:ddc2fef69ef9 441
gmehmet 0:ddc2fef69ef9 442 // get input fifo size
gmehmet 0:ddc2fef69ef9 443 status = sh_get_input_fifo_size(&p_glbl_max8614x_status_track->input_fifo_size);
gmehmet 0:ddc2fef69ef9 444 if (status != SS_SUCCESS) {
gmehmet 0:ddc2fef69ef9 445 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 446 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 447 return COMM_GENERAL_ERROR;;
gmehmet 0:ddc2fef69ef9 448 }
gmehmet 0:ddc2fef69ef9 449
gmehmet 0:ddc2fef69ef9 450 // enable both data stype
gmehmet 0:ddc2fef69ef9 451 p_glbl_max8614x_status_track->data_type_enabled = SS_DATATYPE_BOTH;
gmehmet 0:ddc2fef69ef9 452 p_glbl_max8614x_status_track->sample_count_enabled = false;
gmehmet 0:ddc2fef69ef9 453 status = sh_set_data_type(p_glbl_max8614x_status_track->data_type_enabled,
gmehmet 0:ddc2fef69ef9 454 p_glbl_max8614x_status_track->sample_count_enabled);
gmehmet 0:ddc2fef69ef9 455 if (status != 0) {
gmehmet 0:ddc2fef69ef9 456 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 457 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 458 return COMM_GENERAL_ERROR;
gmehmet 0:ddc2fef69ef9 459 }
gmehmet 0:ddc2fef69ef9 460
gmehmet 0:ddc2fef69ef9 461 status = sh_set_fifo_thresh(15);
gmehmet 0:ddc2fef69ef9 462 if (status != 0) {
gmehmet 0:ddc2fef69ef9 463 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 464 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 465 return COMM_GENERAL_ERROR;
gmehmet 0:ddc2fef69ef9 466 }
gmehmet 0:ddc2fef69ef9 467
gmehmet 0:ddc2fef69ef9 468 status = sh_sensor_enable(SH_SENSORIDX_MAX8614X, SSMAX8614X_MODE1_DATASIZE, SH_INPUT_DATA_DIRECT_SENSOR);
gmehmet 0:ddc2fef69ef9 469 if (status != 0) {
gmehmet 0:ddc2fef69ef9 470 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 471 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 472 return COMM_GENERAL_ERROR;
gmehmet 0:ddc2fef69ef9 473 }
gmehmet 0:ddc2fef69ef9 474 p_glbl_max8614x_status_track->sensor_enabled_mode[SH_SENSORIDX_MAX8614X] = 0x01;
gmehmet 0:ddc2fef69ef9 475
gmehmet 0:ddc2fef69ef9 476 #ifdef ENABLE_SENSOR_HUB_ACCEL
gmehmet 0:ddc2fef69ef9 477 status = sh_sensor_enable(SH_SENSORIDX_ACCEL, SSACCEL_MODE1_DATASIZE, SH_INPUT_DATA_DIRECT_SENSOR);
gmehmet 0:ddc2fef69ef9 478 if (status != SS_SUCCESS) {
gmehmet 0:ddc2fef69ef9 479 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 480 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 481 }
gmehmet 0:ddc2fef69ef9 482 p_glbl_max8614x_status_track->sensor_data_from_host = false;
gmehmet 0:ddc2fef69ef9 483 p_glbl_max8614x_status_track->sensor_enabled_mode[SH_SENSORIDX_ACCEL] = 0x01;
gmehmet 0:ddc2fef69ef9 484 #elif defined(USE_HOST_ACCEL)
gmehmet 0:ddc2fef69ef9 485 CSTMR_SH_HostAccelerometerInitialize();
gmehmet 0:ddc2fef69ef9 486 CSTMR_SH_HostAccelerometerSetDefaults();
gmehmet 0:ddc2fef69ef9 487 status = CSTMR_SH_HostAccelerometerSetSampleRate(BMI160_SAMPLE_RATE);
gmehmet 0:ddc2fef69ef9 488 if (status != 0) {
gmehmet 0:ddc2fef69ef9 489 __DBGMESSAGE("Unable to set BMI160's sample rate\n",NULL)
gmehmet 0:ddc2fef69ef9 490 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 491 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 492 return status;
gmehmet 0:ddc2fef69ef9 493 }
gmehmet 0:ddc2fef69ef9 494
gmehmet 0:ddc2fef69ef9 495 status = CSTMR_SH_HostAccelerometerEnableDataReadyInterrupt();
gmehmet 0:ddc2fef69ef9 496 if(status != 0){
gmehmet 0:ddc2fef69ef9 497 __DBGMESSAGE("Unable to enable BMI160 Interrupt, ret: %d\n", status)
gmehmet 0:ddc2fef69ef9 498 return status;
gmehmet 0:ddc2fef69ef9 499 }
gmehmet 0:ddc2fef69ef9 500
gmehmet 0:ddc2fef69ef9 501 status = sh_sensor_enable(SH_SENSORIDX_ACCEL, SSACCEL_MODE1_DATASIZE, SH_INPUT_DATA_FROM_HOST);
gmehmet 0:ddc2fef69ef9 502 if (status != 0) {
gmehmet 0:ddc2fef69ef9 503 __DBGMESSAGE("\r\n err=%d\r\n", COMM_GENERAL_ERROR)
gmehmet 0:ddc2fef69ef9 504 __DBGMESSAGE("FAILED at line %d\n", __LINE__)
gmehmet 0:ddc2fef69ef9 505 return status;
gmehmet 0:ddc2fef69ef9 506 }
gmehmet 0:ddc2fef69ef9 507 p_glbl_max8614x_status_track->sensor_data_from_host = true;
gmehmet 0:ddc2fef69ef9 508 p_glbl_max8614x_status_track->sensor_enabled_mode[SH_SENSORIDX_ACCEL] = 0x01;
gmehmet 0:ddc2fef69ef9 509 #endif
gmehmet 0:ddc2fef69ef9 510 status = SH_Max8614x_algo_init(paramAlgoMode);
gmehmet 0:ddc2fef69ef9 511 if(status != 0) {
gmehmet 0:ddc2fef69ef9 512 __DBGMESSAGE("AlgoInitFailed\r\n",NULL)
gmehmet 0:ddc2fef69ef9 513 }
gmehmet 0:ddc2fef69ef9 514
gmehmet 0:ddc2fef69ef9 515 __DBGMESSAGE("\r\n err=%d\r\n", status)
gmehmet 0:ddc2fef69ef9 516 return status;
gmehmet 0:ddc2fef69ef9 517 }
gmehmet 0:ddc2fef69ef9 518
gmehmet 0:ddc2fef69ef9 519 void SH_Max8614x_stop() {
gmehmet 0:ddc2fef69ef9 520 sh_disable_irq_mfioevent();
gmehmet 0:ddc2fef69ef9 521 Max86140_SH_Status_Tracker_t *p_glbl_max8614x_status_track = get_config_struct();
gmehmet 0:ddc2fef69ef9 522
gmehmet 0:ddc2fef69ef9 523 for(int i = 0; i < SH_NUM_CURRENT_SENSORS; ++i) {
gmehmet 0:ddc2fef69ef9 524 if(p_glbl_max8614x_status_track->sensor_enabled_mode[i]) {
gmehmet 0:ddc2fef69ef9 525 p_glbl_max8614x_status_track->sensor_enabled_mode[i] = 0;
gmehmet 0:ddc2fef69ef9 526 sh_sensor_disable(i);
gmehmet 0:ddc2fef69ef9 527 }
gmehmet 0:ddc2fef69ef9 528
gmehmet 0:ddc2fef69ef9 529 }
gmehmet 0:ddc2fef69ef9 530
gmehmet 0:ddc2fef69ef9 531 for(int i = 0; i < SH_NUM_CURRENT_ALGOS; ++i) {
gmehmet 0:ddc2fef69ef9 532 if(p_glbl_max8614x_status_track->algo_enabled_mode[i]) {
gmehmet 0:ddc2fef69ef9 533 p_glbl_max8614x_status_track->algo_enabled_mode[i] = 0;
gmehmet 0:ddc2fef69ef9 534 sh_disable_algo(i);
gmehmet 0:ddc2fef69ef9 535 }
gmehmet 0:ddc2fef69ef9 536 }
gmehmet 0:ddc2fef69ef9 537
gmehmet 0:ddc2fef69ef9 538 if(p_glbl_max8614x_status_track->sensor_data_from_host) {
gmehmet 0:ddc2fef69ef9 539 CSTMR_SH_HostAccelerometerInitialize();
gmehmet 0:ddc2fef69ef9 540 p_glbl_max8614x_status_track->sensor_data_from_host = 0;
gmehmet 0:ddc2fef69ef9 541 }
gmehmet 0:ddc2fef69ef9 542
gmehmet 0:ddc2fef69ef9 543 sh_clear_mfio_event_flag();
gmehmet 0:ddc2fef69ef9 544 sh_enable_irq_mfioevent();
gmehmet 0:ddc2fef69ef9 545 }
gmehmet 0:ddc2fef69ef9 546
gmehmet 0:ddc2fef69ef9 547