HSP Platform firmware evaluating ECG data and hearth rate over PPG data.
Dependencies: max32630fthr Adafruit_FeatherOLED USBDevice
Interfaces/SensorComm/SensorComm/SensorComm.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 <ctype.h> |
| gmehmet | 1:f60eafbf009a | 35 | #include "SensorComm.h" |
| gmehmet | 1:f60eafbf009a | 36 | #include "Peripherals.h" |
| gmehmet | 1:f60eafbf009a | 37 | #include "BLE_ICARUS.h" |
| gmehmet | 1:f60eafbf009a | 38 | |
| gmehmet | 1:f60eafbf009a | 39 | //define and initialize the static AsciiEn which is declared in the header |
| gmehmet | 1:f60eafbf009a | 40 | bool SensorComm::AsciiEn=false; |
| gmehmet | 1:f60eafbf009a | 41 | |
| gmehmet | 1:f60eafbf009a | 42 | SensorComm::SensorComm(const char *type, bool visible) |
| gmehmet | 1:f60eafbf009a | 43 | { |
| gmehmet | 1:f60eafbf009a | 44 | sensor = NULL; |
| gmehmet | 1:f60eafbf009a | 45 | sensor_type = type; |
| gmehmet | 1:f60eafbf009a | 46 | vis = visible; |
| gmehmet | 1:f60eafbf009a | 47 | } |
| gmehmet | 1:f60eafbf009a | 48 | |
| gmehmet | 1:f60eafbf009a | 49 | SensorComm::~SensorComm() |
| gmehmet | 1:f60eafbf009a | 50 | { |
| gmehmet | 1:f60eafbf009a | 51 | } |
| gmehmet | 1:f60eafbf009a | 52 | |
| gmehmet | 1:f60eafbf009a | 53 | void SensorComm::comm_init(MaximSensor *s) |
| gmehmet | 1:f60eafbf009a | 54 | { |
| gmehmet | 1:f60eafbf009a | 55 | sensor = s; |
| gmehmet | 1:f60eafbf009a | 56 | } |
| gmehmet | 1:f60eafbf009a | 57 | |
| gmehmet | 1:f60eafbf009a | 58 | const char* SensorComm::get_type() |
| gmehmet | 1:f60eafbf009a | 59 | { |
| gmehmet | 1:f60eafbf009a | 60 | return sensor_type; |
| gmehmet | 1:f60eafbf009a | 61 | } |
| gmehmet | 1:f60eafbf009a | 62 | |
| gmehmet | 1:f60eafbf009a | 63 | unsigned char SensorComm::get_sensor_id() { |
| gmehmet | 1:f60eafbf009a | 64 | |
| gmehmet | 1:f60eafbf009a | 65 | if (sensor!= NULL) |
| gmehmet | 1:f60eafbf009a | 66 | return( sensor->get_sensor_id()); |
| gmehmet | 1:f60eafbf009a | 67 | else |
| gmehmet | 1:f60eafbf009a | 68 | return(255); |
| gmehmet | 1:f60eafbf009a | 69 | } |
| gmehmet | 1:f60eafbf009a | 70 | |
| gmehmet | 1:f60eafbf009a | 71 | const char* SensorComm::get_part_name() |
| gmehmet | 1:f60eafbf009a | 72 | { |
| gmehmet | 1:f60eafbf009a | 73 | if (sensor != NULL) |
| gmehmet | 1:f60eafbf009a | 74 | { |
| gmehmet | 1:f60eafbf009a | 75 | return sensor->get_sensor_part_name(); |
| gmehmet | 1:f60eafbf009a | 76 | } |
| gmehmet | 1:f60eafbf009a | 77 | else |
| gmehmet | 1:f60eafbf009a | 78 | { |
| gmehmet | 1:f60eafbf009a | 79 | return "unknown"; |
| gmehmet | 1:f60eafbf009a | 80 | } |
| gmehmet | 1:f60eafbf009a | 81 | } |
| gmehmet | 1:f60eafbf009a | 82 | |
| gmehmet | 1:f60eafbf009a | 83 | const char* SensorComm::get_algo_ver() |
| gmehmet | 1:f60eafbf009a | 84 | { |
| gmehmet | 1:f60eafbf009a | 85 | if (sensor != NULL) |
| gmehmet | 1:f60eafbf009a | 86 | { |
| gmehmet | 1:f60eafbf009a | 87 | return sensor->get_sensor_algo_ver(); |
| gmehmet | 1:f60eafbf009a | 88 | } |
| gmehmet | 1:f60eafbf009a | 89 | else |
| gmehmet | 1:f60eafbf009a | 90 | { |
| gmehmet | 1:f60eafbf009a | 91 | return "unknown"; |
| gmehmet | 1:f60eafbf009a | 92 | } |
| gmehmet | 1:f60eafbf009a | 93 | } |
| gmehmet | 1:f60eafbf009a | 94 | |
| gmehmet | 1:f60eafbf009a | 95 | int SensorComm::get_part_info(uint8_t *part_id, uint8_t *rev_id) |
| gmehmet | 1:f60eafbf009a | 96 | { |
| gmehmet | 1:f60eafbf009a | 97 | if (sensor != NULL) { |
| gmehmet | 1:f60eafbf009a | 98 | return sensor->get_part_info(part_id, rev_id); |
| gmehmet | 1:f60eafbf009a | 99 | } else { |
| gmehmet | 1:f60eafbf009a | 100 | *part_id = 0xFF; |
| gmehmet | 1:f60eafbf009a | 101 | *rev_id = 0xFF; |
| gmehmet | 1:f60eafbf009a | 102 | return -1; |
| gmehmet | 1:f60eafbf009a | 103 | } |
| gmehmet | 1:f60eafbf009a | 104 | } |
| gmehmet | 1:f60eafbf009a | 105 | |
| gmehmet | 1:f60eafbf009a | 106 | bool SensorComm::is_enabled() |
| gmehmet | 1:f60eafbf009a | 107 | { |
| gmehmet | 1:f60eafbf009a | 108 | return (data_report_mode != 0); |
| gmehmet | 1:f60eafbf009a | 109 | } |
| gmehmet | 1:f60eafbf009a | 110 | |
| gmehmet | 1:f60eafbf009a | 111 | uint8_t SensorComm::get_data_report_mode() |
| gmehmet | 1:f60eafbf009a | 112 | { |
| gmehmet | 1:f60eafbf009a | 113 | return (data_report_mode); |
| gmehmet | 1:f60eafbf009a | 114 | } |
| gmehmet | 1:f60eafbf009a | 115 | |
| gmehmet | 1:f60eafbf009a | 116 | |
| gmehmet | 1:f60eafbf009a | 117 | int SensorComm::sensor_get_reg(char *ptr_ch, uint8_t *reg_addr, uint8_t *value) |
| gmehmet | 1:f60eafbf009a | 118 | { |
| gmehmet | 1:f60eafbf009a | 119 | int ret = EXIT_FAILURE; |
| gmehmet | 1:f60eafbf009a | 120 | uint8_t num_found; |
| gmehmet | 1:f60eafbf009a | 121 | int which_reg; |
| gmehmet | 1:f60eafbf009a | 122 | *value = 0; |
| gmehmet | 1:f60eafbf009a | 123 | |
| gmehmet | 1:f60eafbf009a | 124 | while (*ptr_ch) { |
| gmehmet | 1:f60eafbf009a | 125 | if (isxdigit((int)*ptr_ch)) { |
| gmehmet | 1:f60eafbf009a | 126 | num_found = (uint8_t)sscanf(ptr_ch, "%x", &which_reg); |
| gmehmet | 1:f60eafbf009a | 127 | if (num_found == 1) { |
| gmehmet | 1:f60eafbf009a | 128 | *reg_addr = which_reg; |
| gmehmet | 1:f60eafbf009a | 129 | ret = sensor->readRegister(*reg_addr, value, 1); |
| gmehmet | 1:f60eafbf009a | 130 | } |
| gmehmet | 1:f60eafbf009a | 131 | break; |
| gmehmet | 1:f60eafbf009a | 132 | } else { |
| gmehmet | 1:f60eafbf009a | 133 | ptr_ch++; |
| gmehmet | 1:f60eafbf009a | 134 | } |
| gmehmet | 1:f60eafbf009a | 135 | } |
| gmehmet | 1:f60eafbf009a | 136 | return ret; |
| gmehmet | 1:f60eafbf009a | 137 | } |
| gmehmet | 1:f60eafbf009a | 138 | |
| gmehmet | 1:f60eafbf009a | 139 | int SensorComm::sensor_set_reg(char *ptr_ch) |
| gmehmet | 1:f60eafbf009a | 140 | { |
| gmehmet | 1:f60eafbf009a | 141 | int ret = EXIT_FAILURE; |
| gmehmet | 1:f60eafbf009a | 142 | uint8_t num_found; |
| gmehmet | 1:f60eafbf009a | 143 | unsigned int reg_addr, value; |
| gmehmet | 1:f60eafbf009a | 144 | char *ptr_char; |
| gmehmet | 1:f60eafbf009a | 145 | |
| gmehmet | 1:f60eafbf009a | 146 | ptr_char = ptr_ch; |
| gmehmet | 1:f60eafbf009a | 147 | while (*ptr_char) { |
| gmehmet | 1:f60eafbf009a | 148 | if (isxdigit((int)*ptr_char)) { |
| gmehmet | 1:f60eafbf009a | 149 | num_found = (uint8_t)sscanf(ptr_char, "%x %x", ®_addr, &value); |
| gmehmet | 1:f60eafbf009a | 150 | if (num_found == 2) { |
| gmehmet | 1:f60eafbf009a | 151 | ret = sensor->writeRegister(reg_addr, (uint8_t)value); |
| gmehmet | 1:f60eafbf009a | 152 | } |
| gmehmet | 1:f60eafbf009a | 153 | break; |
| gmehmet | 1:f60eafbf009a | 154 | } else { |
| gmehmet | 1:f60eafbf009a | 155 | ptr_char++; |
| gmehmet | 1:f60eafbf009a | 156 | } |
| gmehmet | 1:f60eafbf009a | 157 | } |
| gmehmet | 1:f60eafbf009a | 158 | return ret; |
| gmehmet | 1:f60eafbf009a | 159 | } |
| gmehmet | 1:f60eafbf009a | 160 | |
| gmehmet | 1:f60eafbf009a | 161 | |
| gmehmet | 1:f60eafbf009a | 162 | int SensorComm::InsertRegValuesIntoBleQeueu(addr_val_pair *reg_values, uint8_t reg_count){ |
| gmehmet | 1:f60eafbf009a | 163 | Reg_Val_BLE values = {0}; |
| gmehmet | 1:f60eafbf009a | 164 | int ret = 0; |
| gmehmet | 1:f60eafbf009a | 165 | |
| gmehmet | 1:f60eafbf009a | 166 | if (!BLE::Instance().gap().getState().connected) |
| gmehmet | 1:f60eafbf009a | 167 | return 0; |
| gmehmet | 1:f60eafbf009a | 168 | |
| gmehmet | 1:f60eafbf009a | 169 | while(reg_count >= kMaxRegisterInOneStruct){ |
| gmehmet | 1:f60eafbf009a | 170 | for(uint8_t i = 0; i < kMaxRegisterInOneStruct; ++i){ |
| gmehmet | 1:f60eafbf009a | 171 | values.reg_adresses[i] = reg_values[i].addr; |
| gmehmet | 1:f60eafbf009a | 172 | values.reg_values[i] = reg_values[i].val; |
| gmehmet | 1:f60eafbf009a | 173 | } |
| gmehmet | 1:f60eafbf009a | 174 | ret |= BLE_Icarus_AddtoQueue((uint8_t *)(&values), sizeof(Reg_Val_BLE), sizeof(Reg_Val_BLE)); |
| gmehmet | 1:f60eafbf009a | 175 | reg_count -= kMaxRegisterInOneStruct; |
| gmehmet | 1:f60eafbf009a | 176 | } |
| gmehmet | 1:f60eafbf009a | 177 | |
| gmehmet | 1:f60eafbf009a | 178 | if(reg_count){ |
| gmehmet | 1:f60eafbf009a | 179 | for(uint8_t i = 0; i < reg_count; ++i){ |
| gmehmet | 1:f60eafbf009a | 180 | values.reg_adresses[i] = reg_values[i].addr; |
| gmehmet | 1:f60eafbf009a | 181 | values.reg_values[i] = reg_values[i].val; |
| gmehmet | 1:f60eafbf009a | 182 | } |
| gmehmet | 1:f60eafbf009a | 183 | ret |= BLE_Icarus_AddtoQueue((uint8_t *)(&values), sizeof(Reg_Val_BLE), sizeof(Reg_Val_BLE)); |
| gmehmet | 1:f60eafbf009a | 184 | } |
| gmehmet | 1:f60eafbf009a | 185 | |
| gmehmet | 1:f60eafbf009a | 186 | return ret; |
| gmehmet | 1:f60eafbf009a | 187 | } |
| gmehmet | 1:f60eafbf009a | 188 | |
| gmehmet | 1:f60eafbf009a | 189 | void SensorComm::stop() { } |
| gmehmet | 1:f60eafbf009a | 190 | |
| gmehmet | 1:f60eafbf009a | 191 | bool SensorComm::parse_command(const char* cmd) { return false; } |
| gmehmet | 1:f60eafbf009a | 192 | |
| gmehmet | 1:f60eafbf009a | 193 | int SensorComm::data_report_execute(char* buf, int size) { return 0; } |
| gmehmet | 1:f60eafbf009a | 194 | |
| gmehmet | 1:f60eafbf009a | 195 | void SensorComm::SensorComm_Set_Ble_Status(bool status) { |
| gmehmet | 1:f60eafbf009a | 196 | m_sensorcomm_ble_interface_exists_ = status; |
| gmehmet | 1:f60eafbf009a | 197 | } |
| gmehmet | 1:f60eafbf009a | 198 | |
| gmehmet | 1:f60eafbf009a | 199 | void SensorComm::SensorComm_Set_Flash_Status(bool status) { |
| gmehmet | 1:f60eafbf009a | 200 | m_sensorcomm_flash_rec_started_ = status; |
| gmehmet | 1:f60eafbf009a | 201 | } |