aurelio carella / Mbed OS mbed-os-example-ble-GattServer_ECG

20200716 read Status Register each second

Dependencies:   SDFileSystem mbed-os-example-ble-GattServer max32630fthr

HSP/RpcServer/StringHelper.cpp@21:51e162c130a9, 2020-07-16 (annotated)

Committer:
aureliocarella
Date:
Thu Jul 16 14:59:04 2020 +0000
Revision:
21:51e162c130a9
20200716

Who changed what in which revision?

UserRevisionLine numberNew contents of line
aureliocarella 21:51e162c130a9 1 /*******************************************************************************
aureliocarella 21:51e162c130a9 2 * Copyright (C) 2016 Maxim Integrated Products, Inc., All Rights Reserved.
aureliocarella 21:51e162c130a9 3 *
aureliocarella 21:51e162c130a9 4 * Permission is hereby granted, free of charge, to any person obtaining a
aureliocarella 21:51e162c130a9 5 * copy of this software and associated documentation files (the "Software"),
aureliocarella 21:51e162c130a9 6 * to deal in the Software without restriction, including without limitation
aureliocarella 21:51e162c130a9 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
aureliocarella 21:51e162c130a9 8 * and/or sell copies of the Software, and to permit persons to whom the
aureliocarella 21:51e162c130a9 9 * Software is furnished to do so, subject to the following conditions:
aureliocarella 21:51e162c130a9 10 *
aureliocarella 21:51e162c130a9 11 * The above copyright notice and this permission notice shall be included
aureliocarella 21:51e162c130a9 12 * in all copies or substantial portions of the Software.
aureliocarella 21:51e162c130a9 13 *
aureliocarella 21:51e162c130a9 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
aureliocarella 21:51e162c130a9 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
aureliocarella 21:51e162c130a9 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
aureliocarella 21:51e162c130a9 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
aureliocarella 21:51e162c130a9 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
aureliocarella 21:51e162c130a9 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
aureliocarella 21:51e162c130a9 20 * OTHER DEALINGS IN THE SOFTWARE.
aureliocarella 21:51e162c130a9 21 *
aureliocarella 21:51e162c130a9 22 * Except as contained in this notice, the name of Maxim Integrated
aureliocarella 21:51e162c130a9 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
aureliocarella 21:51e162c130a9 24 * Products, Inc. Branding Policy.
aureliocarella 21:51e162c130a9 25 *
aureliocarella 21:51e162c130a9 26 * The mere transfer of this software does not imply any licenses
aureliocarella 21:51e162c130a9 27 * of trade secrets, proprietary technology, copyrights, patents,
aureliocarella 21:51e162c130a9 28 * trademarks, maskwork rights, or any other form of intellectual
aureliocarella 21:51e162c130a9 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
aureliocarella 21:51e162c130a9 30 * ownership rights.
aureliocarella 21:51e162c130a9 31 *******************************************************************************
aureliocarella 21:51e162c130a9 32 */
aureliocarella 21:51e162c130a9 33 #include "mbed.h"
aureliocarella 21:51e162c130a9 34 #include "StringHelper.h"
aureliocarella 21:51e162c130a9 35
aureliocarella 21:51e162c130a9 36 /**
aureliocarella 21:51e162c130a9 37 * @brief Process an array of hex alpha numeric strings representing arguments of
aureliocarella 21:51e162c130a9 38 * type uint8
aureliocarella 21:51e162c130a9 39 * @param args Array of strings to process
aureliocarella 21:51e162c130a9 40 * @param argsUintPtr Pointer of uint8 to save converted arguments
aureliocarella 21:51e162c130a9 41 * @param numberOf Number of strings to convert
aureliocarella 21:51e162c130a9 42 */
aureliocarella 21:51e162c130a9 43 void ProcessArgs(char args[32][32], uint8_t *argsUintPtr, int numberOf) {
aureliocarella 21:51e162c130a9 44 int i;
aureliocarella 21:51e162c130a9 45 int val;
aureliocarella 21:51e162c130a9 46 for (i = 0; i < numberOf; i++) {
aureliocarella 21:51e162c130a9 47 sscanf(args[i], "%x", &val);
aureliocarella 21:51e162c130a9 48 argsUintPtr[i] = (uint8_t)val;
aureliocarella 21:51e162c130a9 49 }
aureliocarella 21:51e162c130a9 50 }
aureliocarella 21:51e162c130a9 51
aureliocarella 21:51e162c130a9 52 /**
aureliocarella 21:51e162c130a9 53 * @brief Process an array of hex alpha numeric strings representing arguments of
aureliocarella 21:51e162c130a9 54 * type uint32
aureliocarella 21:51e162c130a9 55 * @param args Array of strings to process
aureliocarella 21:51e162c130a9 56 * @param argsUintPtr Pointer of uint32 to save converted arguments
aureliocarella 21:51e162c130a9 57 * @param numberOf Number of strings to convert
aureliocarella 21:51e162c130a9 58 */
aureliocarella 21:51e162c130a9 59 void ProcessArgs32(char args[32][32], uint32_t *argsUintPtr, int numberOf) {
aureliocarella 21:51e162c130a9 60 int i;
aureliocarella 21:51e162c130a9 61 int val;
aureliocarella 21:51e162c130a9 62 for (i = 0; i < numberOf; i++) {
aureliocarella 21:51e162c130a9 63 sscanf(args[i], "%x", &val);
aureliocarella 21:51e162c130a9 64 argsUintPtr[i] = val;
aureliocarella 21:51e162c130a9 65 }
aureliocarella 21:51e162c130a9 66 }
aureliocarella 21:51e162c130a9 67
aureliocarella 21:51e162c130a9 68 /**
aureliocarella 21:51e162c130a9 69 * @brief Process an array of decimal numeric strings representing arguments of
aureliocarella 21:51e162c130a9 70 * type uint32
aureliocarella 21:51e162c130a9 71 * @param args Array of strings to process
aureliocarella 21:51e162c130a9 72 * @param argsUintPtr Pointer of uint32 to save converted arguments
aureliocarella 21:51e162c130a9 73 * @param numberOf Number of strings to convert
aureliocarella 21:51e162c130a9 74 */
aureliocarella 21:51e162c130a9 75 void ProcessArgs32Dec(char args[32][32], uint32_t *argsUintPtr, int numberOf) {
aureliocarella 21:51e162c130a9 76 int i;
aureliocarella 21:51e162c130a9 77 int val;
aureliocarella 21:51e162c130a9 78 for (i = 0; i < numberOf; i++) {
aureliocarella 21:51e162c130a9 79 sscanf(args[i], "%d", &val);
aureliocarella 21:51e162c130a9 80 argsUintPtr[i] = val;
aureliocarella 21:51e162c130a9 81 }
aureliocarella 21:51e162c130a9 82 }
aureliocarella 21:51e162c130a9 83
aureliocarella 21:51e162c130a9 84 /**
aureliocarella 21:51e162c130a9 85 * @brief Parse a single string in decimal format to a uint32 number
aureliocarella 21:51e162c130a9 86 * @param str String to process
aureliocarella 21:51e162c130a9 87 * @returns Returns the converted number of type uint32
aureliocarella 21:51e162c130a9 88 */
aureliocarella 21:51e162c130a9 89 uint32_t ParseAsciiDecU32(char *str) {
aureliocarella 21:51e162c130a9 90 uint32_t val;
aureliocarella 21:51e162c130a9 91 sscanf(str, "%d", &val);
aureliocarella 21:51e162c130a9 92 return val;
aureliocarella 21:51e162c130a9 93 }
aureliocarella 21:51e162c130a9 94
aureliocarella 21:51e162c130a9 95 /**
aureliocarella 21:51e162c130a9 96 * @brief Parse a single string in hex format to a uint32 number
aureliocarella 21:51e162c130a9 97 * @param str String to process
aureliocarella 21:51e162c130a9 98 * @returns Returns the converted number of type uint32
aureliocarella 21:51e162c130a9 99 */
aureliocarella 21:51e162c130a9 100 uint32_t ParseAsciiHexU32(char *str) {
aureliocarella 21:51e162c130a9 101 uint32_t val;
aureliocarella 21:51e162c130a9 102 sscanf(str, "%x", &val);
aureliocarella 21:51e162c130a9 103 return val;
aureliocarella 21:51e162c130a9 104 }
aureliocarella 21:51e162c130a9 105
aureliocarella 21:51e162c130a9 106 /**
aureliocarella 21:51e162c130a9 107 * @brief Process a string that is "embedded" within another string using the /"
aureliocarella 21:51e162c130a9 108 * delimiters
aureliocarella 21:51e162c130a9 109 * @brief Extract the string
aureliocarella 21:51e162c130a9 110 * @param str String to process
aureliocarella 21:51e162c130a9 111 * @returns Returns the string
aureliocarella 21:51e162c130a9 112 */
aureliocarella 21:51e162c130a9 113 void ProcessString(char args[32][32], uint8_t *str, int numberOf) {
aureliocarella 21:51e162c130a9 114 int i;
aureliocarella 21:51e162c130a9 115 int start;
aureliocarella 21:51e162c130a9 116 uint8_t *ptr;
aureliocarella 21:51e162c130a9 117 uint8_t *strPtr;
aureliocarella 21:51e162c130a9 118 ptr = (uint8_t *)args;
aureliocarella 21:51e162c130a9 119 strPtr = str;
aureliocarella 21:51e162c130a9 120 start = 0;
aureliocarella 21:51e162c130a9 121 for (i = 0; i < numberOf; i++) {
aureliocarella 21:51e162c130a9 122 if ((start == 0) && (*ptr == '/"')) {
aureliocarella 21:51e162c130a9 123 start = 1;
aureliocarella 21:51e162c130a9 124 ptr++;
aureliocarella 21:51e162c130a9 125 continue;
aureliocarella 21:51e162c130a9 126 }
aureliocarella 21:51e162c130a9 127 if ((start == 1) && (*ptr == '/"')) {
aureliocarella 21:51e162c130a9 128 break;
aureliocarella 21:51e162c130a9 129 }
aureliocarella 21:51e162c130a9 130 if (start == 1) {
aureliocarella 21:51e162c130a9 131 *strPtr = *ptr;
aureliocarella 21:51e162c130a9 132 strPtr++;
aureliocarella 21:51e162c130a9 133 }
aureliocarella 21:51e162c130a9 134 ptr++;
aureliocarella 21:51e162c130a9 135 }
aureliocarella 21:51e162c130a9 136 // terminate the string
aureliocarella 21:51e162c130a9 137 *strPtr = 0;
aureliocarella 21:51e162c130a9 138 }
aureliocarella 21:51e162c130a9 139
aureliocarella 21:51e162c130a9 140 /**
aureliocarella 21:51e162c130a9 141 * @brief Parse an incoming string until a CRLF is encountered, dst will contain
aureliocarella 21:51e162c130a9 142 * the parsed string
aureliocarella 21:51e162c130a9 143 * @param src source string to process
aureliocarella 21:51e162c130a9 144 * @param dst destination string to contain the parsed incoming string
aureliocarella 21:51e162c130a9 145 * @param length length of incoming src string
aureliocarella 21:51e162c130a9 146 * @returns updated pointer in src string
aureliocarella 21:51e162c130a9 147 */
aureliocarella 21:51e162c130a9 148 char *ParseUntilCRLF(char *src, char *dst, int length) {
aureliocarella 21:51e162c130a9 149 int i;
aureliocarella 21:51e162c130a9 150 char *srcPtr;
aureliocarella 21:51e162c130a9 151
aureliocarella 21:51e162c130a9 152 srcPtr = src;
aureliocarella 21:51e162c130a9 153 i = 0;
aureliocarella 21:51e162c130a9 154 *dst = 0;
aureliocarella 21:51e162c130a9 155 while ((*srcPtr != 0) && (*srcPtr != 13)) {
aureliocarella 21:51e162c130a9 156 dst[i] = *srcPtr;
aureliocarella 21:51e162c130a9 157 i++;
aureliocarella 21:51e162c130a9 158 if (i >= length)
aureliocarella 21:51e162c130a9 159 break;
aureliocarella 21:51e162c130a9 160 srcPtr++;
aureliocarella 21:51e162c130a9 161 }
aureliocarella 21:51e162c130a9 162 if (*srcPtr == 13)
aureliocarella 21:51e162c130a9 163 srcPtr++;
aureliocarella 21:51e162c130a9 164 if (*srcPtr == 10)
aureliocarella 21:51e162c130a9 165 srcPtr++;
aureliocarella 21:51e162c130a9 166 dst[i] = 0; // terminate the string
aureliocarella 21:51e162c130a9 167 return srcPtr;
aureliocarella 21:51e162c130a9 168 }
aureliocarella 21:51e162c130a9 169
aureliocarella 21:51e162c130a9 170 /**
aureliocarella 21:51e162c130a9 171 * @brief Parse an incoming string hex value into an 8-bit value
aureliocarella 21:51e162c130a9 172 * @param str string to process
aureliocarella 21:51e162c130a9 173 * @returns 8-bit byte that is parsed from the string
aureliocarella 21:51e162c130a9 174 */
aureliocarella 21:51e162c130a9 175 uint8_t StringToByte(char str[32]) {
aureliocarella 21:51e162c130a9 176 int val;
aureliocarella 21:51e162c130a9 177 uint8_t byt;
aureliocarella 21:51e162c130a9 178 sscanf(str, "%x", &val);
aureliocarella 21:51e162c130a9 179 byt = (uint8_t)val;
aureliocarella 21:51e162c130a9 180 return byt;
aureliocarella 21:51e162c130a9 181 }
aureliocarella 21:51e162c130a9 182
aureliocarella 21:51e162c130a9 183 /**
aureliocarella 21:51e162c130a9 184 * @brief Parse an incoming string hex value into 32-bit value
aureliocarella 21:51e162c130a9 185 * @param str string to process
aureliocarella 21:51e162c130a9 186 * @returns 32-bit value that is parsed from the string
aureliocarella 21:51e162c130a9 187 */
aureliocarella 21:51e162c130a9 188 uint32_t StringToInt(char str[32]) {
aureliocarella 21:51e162c130a9 189 int val;
aureliocarella 21:51e162c130a9 190 uint32_t byt;
aureliocarella 21:51e162c130a9 191 sscanf(str, "%x", &val);
aureliocarella 21:51e162c130a9 192 byt = (uint32_t)val;
aureliocarella 21:51e162c130a9 193 return byt;
aureliocarella 21:51e162c130a9 194 }
aureliocarella 21:51e162c130a9 195
aureliocarella 21:51e162c130a9 196 /**
aureliocarella 21:51e162c130a9 197 * @brief Format a binary 8-bit array into a string
aureliocarella 21:51e162c130a9 198 * @param uint8Ptr byte buffer to process
aureliocarella 21:51e162c130a9 199 * @param numberOf number of bytes in the buffer
aureliocarella 21:51e162c130a9 200 * @param reply an array of strings to place the converted array values into
aureliocarella 21:51e162c130a9 201 */
aureliocarella 21:51e162c130a9 202 void FormatReply(uint8_t *uint8Ptr, int numberOf, char reply[32][32]) {
aureliocarella 21:51e162c130a9 203 int i;
aureliocarella 21:51e162c130a9 204 for (i = 0; i < numberOf; i++) {
aureliocarella 21:51e162c130a9 205 sprintf(reply[i], "%02X", uint8Ptr[i]);
aureliocarella 21:51e162c130a9 206 }
aureliocarella 21:51e162c130a9 207 strcpy(reply[i], "\0");
aureliocarella 21:51e162c130a9 208 }
aureliocarella 21:51e162c130a9 209
aureliocarella 21:51e162c130a9 210 /**
aureliocarella 21:51e162c130a9 211 * @brief Format a binary 32-bit array into a string
aureliocarella 21:51e162c130a9 212 * @param uint32Ptr 32-bit value buffer to process
aureliocarella 21:51e162c130a9 213 * @param numberOf number of values in the buffer
aureliocarella 21:51e162c130a9 214 * @param reply an array of strings to place the converted array values into
aureliocarella 21:51e162c130a9 215 */
aureliocarella 21:51e162c130a9 216 void FormatReply32(uint32_t *uint32Ptr, int numberOf, char reply[32][32]) {
aureliocarella 21:51e162c130a9 217 int i;
aureliocarella 21:51e162c130a9 218 for (i = 0; i < numberOf; i++) {
aureliocarella 21:51e162c130a9 219 sprintf(reply[i], "%02X", uint32Ptr[i]);
aureliocarella 21:51e162c130a9 220 }
aureliocarella 21:51e162c130a9 221 strcpy(reply[i], "\0");
aureliocarella 21:51e162c130a9 222 }
aureliocarella 21:51e162c130a9 223
aureliocarella 21:51e162c130a9 224 /**
aureliocarella 21:51e162c130a9 225 * @brief Format a binary 8-bit array into a string
aureliocarella 21:51e162c130a9 226 * @param data 8-bit value buffer to process
aureliocarella 21:51e162c130a9 227 * @param length number of values in the buffer
aureliocarella 21:51e162c130a9 228 * @param str output string buffer
aureliocarella 21:51e162c130a9 229 * @return output string
aureliocarella 21:51e162c130a9 230 */
aureliocarella 21:51e162c130a9 231 char *BytesToHexStr(uint8_t *data, uint32_t length, char *str) {
aureliocarella 21:51e162c130a9 232 uint32_t i;
aureliocarella 21:51e162c130a9 233 char tmpStr[8];
aureliocarella 21:51e162c130a9 234 str[0] = 0;
aureliocarella 21:51e162c130a9 235 for (i = 0; i < length; i++) {
aureliocarella 21:51e162c130a9 236 sprintf(tmpStr, "%02X ", data[i]);
aureliocarella 21:51e162c130a9 237 strcat(str, tmpStr);
aureliocarella 21:51e162c130a9 238 }
aureliocarella 21:51e162c130a9 239 return str;
aureliocarella 21:51e162c130a9 240 }
aureliocarella 21:51e162c130a9 241