HSP Platform firmware evaluating ECG data and hearth rate over PPG data.

Dependencies:   max32630fthr Adafruit_FeatherOLED USBDevice

Committer:
gmehmet
Date:
Wed Apr 10 14:56:25 2019 +0300
Revision:
1:f60eafbf009a
upload from local

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gmehmet 1:f60eafbf009a 1 /*******************************************************************************
gmehmet 1:f60eafbf009a 2 * Copyright (C) 2017 Maxim Integrated Products, Inc., All Rights Reserved.
gmehmet 1:f60eafbf009a 3 *
gmehmet 1:f60eafbf009a 4 * Permission is hereby granted, free of charge, to any person obtaining a
gmehmet 1:f60eafbf009a 5 * copy of this software and associated documentation files (the "Software"),
gmehmet 1:f60eafbf009a 6 * to deal in the Software without restriction, including without limitation
gmehmet 1:f60eafbf009a 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
gmehmet 1:f60eafbf009a 8 * and/or sell copies of the Software, and to permit persons to whom the
gmehmet 1:f60eafbf009a 9 * Software is furnished to do so, subject to the following conditions:
gmehmet 1:f60eafbf009a 10 *
gmehmet 1:f60eafbf009a 11 * The above copyright notice and this permission notice shall be included
gmehmet 1:f60eafbf009a 12 * in all copies or substantial portions of the Software.
gmehmet 1:f60eafbf009a 13 *
gmehmet 1:f60eafbf009a 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
gmehmet 1:f60eafbf009a 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
gmehmet 1:f60eafbf009a 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
gmehmet 1:f60eafbf009a 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
gmehmet 1:f60eafbf009a 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
gmehmet 1:f60eafbf009a 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
gmehmet 1:f60eafbf009a 20 * OTHER DEALINGS IN THE SOFTWARE.
gmehmet 1:f60eafbf009a 21 *
gmehmet 1:f60eafbf009a 22 * Except as contained in this notice, the name of Maxim Integrated
gmehmet 1:f60eafbf009a 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
gmehmet 1:f60eafbf009a 24 * Products, Inc. Branding Policy.
gmehmet 1:f60eafbf009a 25 *
gmehmet 1:f60eafbf009a 26 * The mere transfer of this software does not imply any licenses
gmehmet 1:f60eafbf009a 27 * of trade secrets, proprietary technology, copyrights, patents,
gmehmet 1:f60eafbf009a 28 * trademarks, maskwork rights, or any other form of intellectual
gmehmet 1:f60eafbf009a 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
gmehmet 1:f60eafbf009a 30 * ownership rights.
gmehmet 1:f60eafbf009a 31 *******************************************************************************
gmehmet 1:f60eafbf009a 32 */
gmehmet 1:f60eafbf009a 33
gmehmet 1:f60eafbf009a 34 #include "DSInterface.h"
gmehmet 1:f60eafbf009a 35 #include "SSGenericCmd.h"
gmehmet 1:f60eafbf009a 36
gmehmet 1:f60eafbf009a 37 #include "../../../../Utilities/mxm_assert.h"
gmehmet 1:f60eafbf009a 38 #include "Peripherals.h"
gmehmet 1:f60eafbf009a 39 #include "utils.h"
gmehmet 1:f60eafbf009a 40 #include "CRC8.h"
gmehmet 1:f60eafbf009a 41
gmehmet 1:f60eafbf009a 42 static const char* const cmd_tbl[] = {
gmehmet 1:f60eafbf009a 43 "ss_write",
gmehmet 1:f60eafbf009a 44 "ss_read",
gmehmet 1:f60eafbf009a 45 };
gmehmet 1:f60eafbf009a 46
gmehmet 1:f60eafbf009a 47 SSGenericCmd::SSGenericCmd(USBSerial *USB, SSInterface* ssInterface, DSInterface* dsInterface)
gmehmet 1:f60eafbf009a 48 :SensorComm("ss_test", false), m_USB(USB), ss_int(ssInterface), ds_int(dsInterface)
gmehmet 1:f60eafbf009a 49 {
gmehmet 1:f60eafbf009a 50 }
gmehmet 1:f60eafbf009a 51
gmehmet 1:f60eafbf009a 52 bool SSGenericCmd::parse_command(const char* cmd)
gmehmet 1:f60eafbf009a 53 {
gmehmet 1:f60eafbf009a 54 SS_STATUS status;
gmehmet 1:f60eafbf009a 55 bool recognizedCmd = false;
gmehmet 1:f60eafbf009a 56 char response[1024];
gmehmet 1:f60eafbf009a 57 int ridx = 0;
gmehmet 1:f60eafbf009a 58
gmehmet 1:f60eafbf009a 59 if (!ss_int) {
gmehmet 1:f60eafbf009a 60 pr_err("No SmartSensor Interface defined!");
gmehmet 1:f60eafbf009a 61 return false;
gmehmet 1:f60eafbf009a 62 }
gmehmet 1:f60eafbf009a 63 if (!ds_int) {
gmehmet 1:f60eafbf009a 64 pr_err("No DeviceStudio Interface defined!");
gmehmet 1:f60eafbf009a 65 return false;
gmehmet 1:f60eafbf009a 66 }
gmehmet 1:f60eafbf009a 67
gmehmet 1:f60eafbf009a 68 for (int i = 0; i < NUM_CMDS; i++) {
gmehmet 1:f60eafbf009a 69 if (starts_with(cmd, cmd_tbl[i])) {
gmehmet 1:f60eafbf009a 70 cmd_state_t user_cmd = (cmd_state_t)i;
gmehmet 1:f60eafbf009a 71 recognizedCmd = true;
gmehmet 1:f60eafbf009a 72
gmehmet 1:f60eafbf009a 73 switch (user_cmd) {
gmehmet 1:f60eafbf009a 74 case (ss_write):
gmehmet 1:f60eafbf009a 75 {
gmehmet 1:f60eafbf009a 76 uint8_t cmd_bytes[256];
gmehmet 1:f60eafbf009a 77 int num_cmd_bytes = parse_cmd_data(cmd, cmd_tbl[i], &cmd_bytes[0], sizeof(cmd_bytes), true);
gmehmet 1:f60eafbf009a 78 if (num_cmd_bytes <= 0) {
gmehmet 1:f60eafbf009a 79 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 80 "\r\n%s err=%d", cmd, num_cmd_bytes);
gmehmet 1:f60eafbf009a 81 break;
gmehmet 1:f60eafbf009a 82 }
gmehmet 1:f60eafbf009a 83
gmehmet 1:f60eafbf009a 84 status = ss_int->write_cmd(&cmd_bytes[0], num_cmd_bytes,
gmehmet 1:f60eafbf009a 85 0, 0, 500);
gmehmet 1:f60eafbf009a 86 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 87 "\r\n%s err=0\r\n", cmd);
gmehmet 1:f60eafbf009a 88
gmehmet 1:f60eafbf009a 89 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 90 "\r\nWrote: { ");
gmehmet 1:f60eafbf009a 91 for (int i = 0; i < num_cmd_bytes; i++) {
gmehmet 1:f60eafbf009a 92 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 93 "%02X ", cmd_bytes[i]);
gmehmet 1:f60eafbf009a 94 }
gmehmet 1:f60eafbf009a 95 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 96 "}\r\n");
gmehmet 1:f60eafbf009a 97 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 98 "Status: { %02X }\r\n", (uint8_t)status);
gmehmet 1:f60eafbf009a 99
gmehmet 1:f60eafbf009a 100 } break;
gmehmet 1:f60eafbf009a 101
gmehmet 1:f60eafbf009a 102 case (ss_read):
gmehmet 1:f60eafbf009a 103 {
gmehmet 1:f60eafbf009a 104 uint8_t cmd_bytes[256];
gmehmet 1:f60eafbf009a 105 uint8_t read_bytes[256];
gmehmet 1:f60eafbf009a 106
gmehmet 1:f60eafbf009a 107
gmehmet 1:f60eafbf009a 108 int num_cmd_bytes = parse_cmd_data(cmd, cmd_tbl[i], &cmd_bytes[0], sizeof(cmd_bytes), true);
gmehmet 1:f60eafbf009a 109 if (num_cmd_bytes <= 0) {
gmehmet 1:f60eafbf009a 110 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 111 "\r\n%s err=%d", cmd, num_cmd_bytes);
gmehmet 1:f60eafbf009a 112 break;
gmehmet 1:f60eafbf009a 113 }
gmehmet 1:f60eafbf009a 114
gmehmet 1:f60eafbf009a 115 //Last space separated value is the number of bytes to read
gmehmet 1:f60eafbf009a 116 uint8_t num_rx_bytes = cmd_bytes[num_cmd_bytes - 1];
gmehmet 1:f60eafbf009a 117 if (num_rx_bytes > sizeof(read_bytes)) {
gmehmet 1:f60eafbf009a 118 pr_err("Can read up to %d bytes", num_rx_bytes);
gmehmet 1:f60eafbf009a 119 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 120 "\r\n%s err=-1", cmd);
gmehmet 1:f60eafbf009a 121 break;
gmehmet 1:f60eafbf009a 122 }
gmehmet 1:f60eafbf009a 123
gmehmet 1:f60eafbf009a 124 status = ss_int->read_cmd(&cmd_bytes[0], num_cmd_bytes - 1,
gmehmet 1:f60eafbf009a 125 0, 0,
gmehmet 1:f60eafbf009a 126 &read_bytes[0], num_rx_bytes,
gmehmet 1:f60eafbf009a 127 500);
gmehmet 1:f60eafbf009a 128
gmehmet 1:f60eafbf009a 129 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 130 "\r\n%s err=0\r\n", cmd);
gmehmet 1:f60eafbf009a 131
gmehmet 1:f60eafbf009a 132 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 133 "\r\nWrote: { ");
gmehmet 1:f60eafbf009a 134 for (int i = 0; i < num_cmd_bytes; i++) {
gmehmet 1:f60eafbf009a 135 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 136 "%02X ", cmd_bytes[i]);
gmehmet 1:f60eafbf009a 137 }
gmehmet 1:f60eafbf009a 138 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 139 "}\r\n");
gmehmet 1:f60eafbf009a 140 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 141 "Read: { ");
gmehmet 1:f60eafbf009a 142 for (int i = 0; i < num_rx_bytes; i++) {
gmehmet 1:f60eafbf009a 143 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 144 "%02X ", read_bytes[i]);
gmehmet 1:f60eafbf009a 145 }
gmehmet 1:f60eafbf009a 146 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 147 "}\r\n");
gmehmet 1:f60eafbf009a 148 ridx += snprintf(response + ridx, sizeof(response) - ridx - 1,
gmehmet 1:f60eafbf009a 149 "Status: { %02X }\r\n", (uint8_t)status);
gmehmet 1:f60eafbf009a 150
gmehmet 1:f60eafbf009a 151 } break;
gmehmet 1:f60eafbf009a 152
gmehmet 1:f60eafbf009a 153 default:
gmehmet 1:f60eafbf009a 154 {
gmehmet 1:f60eafbf009a 155 recognizedCmd = false;
gmehmet 1:f60eafbf009a 156 mxm_assert_msg(false, "Invalid switch case!");
gmehmet 1:f60eafbf009a 157 } break;
gmehmet 1:f60eafbf009a 158
gmehmet 1:f60eafbf009a 159 }
gmehmet 1:f60eafbf009a 160 break;
gmehmet 1:f60eafbf009a 161 }
gmehmet 1:f60eafbf009a 162 }
gmehmet 1:f60eafbf009a 163
gmehmet 1:f60eafbf009a 164 if (recognizedCmd) {
gmehmet 1:f60eafbf009a 165 m_USB->printf(response);
gmehmet 1:f60eafbf009a 166 }
gmehmet 1:f60eafbf009a 167
gmehmet 1:f60eafbf009a 168 return recognizedCmd;
gmehmet 1:f60eafbf009a 169 }