1 /*
2 * Copyright (c) 2017, The OpenThread Authors.
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions are met:
7 * 1. Redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution.
12 * 3. Neither the name of the copyright holder nor the
13 * names of its contributors may be used to endorse or promote products
14 * derived from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
17 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
20 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 * POSSIBILITY OF SUCH DAMAGE.
27 */
28
29 /**
30 * @file
31 * This file provides kinds of convertion functions.
32 */
33
34 #include "utils/hex.hpp"
35
36 #include <string>
37
38 #include <stdio.h>
39 #include <string.h>
40
41 namespace otbr {
42
43 namespace Utils {
44
Hex2Bytes(const char * aHex,uint8_t * aBytes,uint16_t aBytesLength)45 int Hex2Bytes(const char *aHex, uint8_t *aBytes, uint16_t aBytesLength)
46 {
47 size_t hexLength = strlen(aHex);
48 const char *hexEnd = aHex + hexLength;
49 uint8_t * cur = aBytes;
50 uint8_t numChars = hexLength & 1;
51 uint8_t byte = 0;
52
53 if ((hexLength + 1) / 2 > aBytesLength)
54 {
55 return -1;
56 }
57
58 while (aHex < hexEnd)
59 {
60 if ('A' <= *aHex && *aHex <= 'F')
61 {
62 byte |= 10 + (*aHex - 'A');
63 }
64 else if ('a' <= *aHex && *aHex <= 'f')
65 {
66 byte |= 10 + (*aHex - 'a');
67 }
68 else if ('0' <= *aHex && *aHex <= '9')
69 {
70 byte |= *aHex - '0';
71 }
72 else
73 {
74 return -1;
75 }
76
77 aHex++;
78 numChars++;
79
80 if (numChars >= 2)
81 {
82 numChars = 0;
83 *cur++ = byte;
84 byte = 0;
85 }
86 else
87 {
88 byte <<= 4;
89 }
90 }
91
92 return static_cast<int>(cur - aBytes);
93 }
94
Bytes2Hex(const uint8_t * aBytes,const uint16_t aBytesLength,char * aHex)95 size_t Bytes2Hex(const uint8_t *aBytes, const uint16_t aBytesLength, char *aHex)
96 {
97 char byteHex[3];
98
99 std::string hexString;
100 uint8_t cur[aBytesLength];
101
102 memcpy(cur, aBytes, aBytesLength);
103
104 for (int i = 0; i < aBytesLength; i++)
105 {
106 sprintf(byteHex, "%02X", cur[i]);
107 hexString += byteHex;
108 }
109 strcpy(aHex, hexString.c_str());
110 return strlen(aHex);
111 }
112
Long2Hex(const uint64_t aLong,char * aHex)113 size_t Long2Hex(const uint64_t aLong, char *aHex)
114 {
115 std::string hexString;
116 char byteHex[3];
117 uint64_t longValue = aLong;
118
119 for (uint8_t i = 0; i < sizeof(uint64_t); i++)
120 {
121 uint8_t byte = longValue & 0xff;
122 sprintf(byteHex, "%02X", byte);
123 hexString += byteHex;
124 longValue = longValue >> 8;
125 }
126 strcpy(aHex, hexString.c_str());
127 return strlen(aHex);
128 }
129
130 } // namespace Utils
131
132 } // namespace otbr
133