Darien Figueroa / Mbed 2 deprecated repo3

repo time

Dependencies:   mbed MAX14720 MAX30205 USBDevice

e4a10ed6eb92/HSP/RpcServer/StringHelper.cpp@20:6d2af70c92ab, 2021-04-06 (annotated)

Committer:
darienf
Date:
Tue Apr 06 06:41:40 2021 +0000
Revision:
20:6d2af70c92ab
another repo

Who changed what in which revision?

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