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