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_WHRM/SH_Max8614x_WHRM.cpp@13:3d1a6b947396, 2019-01-10 (annotated)

Committer:
gmehmet
Date:
Thu Jan 10 11:06:01 2019 +0300
Revision:
13:3d1a6b947396
Code for evaluating Max3266x Heart Rate from Wrist Agorithm

Who changed what in which revision?

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