Jerry Bradshaw / Mbed OS HSP_Release

This is a mbed 5.2 Release

Dependencies:   USBDevice

Fork of mbed-os-test by Jerry Bradshaw

HSP/RpcServer/StringHelper.cpp@0:e4a10ed6eb92, 2016-10-25 (annotated)

Committer:
jbradshaw
Date:
Tue Oct 25 15:22:11 2016 +0000
Revision:
0:e4a10ed6eb92
tewt

Who changed what in which revision?

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