HSP Platform firmware evaluating ECG data and hearth rate over PPG data.
Dependencies: max32630fthr Adafruit_FeatherOLED USBDevice
Interfaces/SensorComm/SmartSensorComm/SSGenericCmd/SSGenericCmd.cpp@1:f60eafbf009a, 2019-04-10 (annotated)
- Committer:
- gmehmet
- Date:
- Wed Apr 10 14:56:25 2019 +0300
- Revision:
- 1:f60eafbf009a
upload from local
Who changed what in which revision?
| User | Revision | Line number | New 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 | } |