2 utils.c -- gathering of some stupid small functions
3 Copyright (C) 2014 Guus Sliepen <guus@meshlink.io>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License along
16 with this program; if not, write to the Free Software Foundation, Inc.,
17 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
22 #include "../src/logger.h"
25 static const char hexadecimals[] = "0123456789ABCDEF";
26 static const char base64_original[] = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
27 static const char base64_urlsafe[] = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789-_";
28 static const char base64_decode[256] = {
29 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
30 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
31 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, 62, -1, 62, -1, 63,
32 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, -1, -1, -1, -1, -1, -1,
33 -1, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
34 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, -1, -1, -1, -1, 63,
35 -1, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40,
36 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, -1, -1, -1, -1, -1,
37 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
38 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
39 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
40 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
41 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
42 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
43 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
44 -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
47 static int charhex2bin(char c) {
51 return toupper(c) - 'A' + 10;
54 int hex2bin(const char *src, void *vdst, int length) {
57 for(i = 0; i < length && isxdigit(src[i * 2]) && isxdigit(src[i * 2 + 1]); i++)
58 dst[i] = charhex2bin(src[i * 2]) * 16 + charhex2bin(src[i * 2 + 1]);
62 int bin2hex(const void *vsrc, char *dst, int length) {
63 const uint8_t *src = vsrc;
64 for(int i = length - 1; i >= 0; i--) {
65 dst[i * 2 + 1] = hexadecimals[(unsigned char) src[i] & 15];
66 dst[i * 2] = hexadecimals[(unsigned char) src[i] >> 4];
72 int b64decode(const char *src, void *dst, int length) {
75 unsigned char *udst = dst;
77 for(i = 0; i < length / 3 * 4 && src[i]; i++) {
78 triplet |= base64_decode[src[i] & 0xff] << (6 * (i & 3));
80 if(triplet & 0xff000000U)
82 udst[0] = triplet & 0xff;
84 udst[1] = triplet & 0xff;
91 if(triplet & 0xff000000U)
94 udst[0] = triplet & 0xff;
96 udst[1] = triplet & 0xff;
98 } else if((i & 3) == 2) {
99 udst[0] = triplet & 0xff;
100 return i / 4 * 3 + 1;
105 static int b64encode_internal(const void *src, char *dst, int length, const char *alphabet) {
107 const unsigned char *usrc = src;
108 int si = length / 3 * 3;
109 int di = length / 3 * 4;
113 triplet = usrc[si] | usrc[si + 1] << 8;
114 dst[di] = alphabet[triplet & 63];
116 dst[di + 1] = alphabet[triplet & 63];
118 dst[di + 2] = alphabet[triplet];
124 dst[di] = alphabet[triplet & 63];
126 dst[di + 1] = alphabet[triplet];
139 triplet = usrc[si] | usrc[si + 1] << 8 | usrc[si + 2] << 16;
140 dst[di] = alphabet[triplet & 63];
142 dst[di + 1] = alphabet[triplet & 63];
144 dst[di + 2] = alphabet[triplet & 63];
146 dst[di + 3] = alphabet[triplet];
152 int b64encode(const void *src, char *dst, int length) {
153 return b64encode_internal(src, dst, length, base64_original);
156 int b64encode_urlsafe(const void *src, char *dst, int length) {
157 return b64encode_internal(src, dst, length, base64_urlsafe);
160 #if defined(HAVE_MINGW) || defined(HAVE_CYGWIN)
162 #include <w32api/windows.h>
165 const char *winerror(int err) {
166 static char buf[1024], *ptr;
168 ptr = buf + sprintf(buf, "(%d) ", err);
170 if(!FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM | FORMAT_MESSAGE_IGNORE_INSERTS,
171 NULL, err, MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), ptr, sizeof(buf) - (ptr - buf), NULL))
172 strncpy(buf, "(unable to format errormessage)", sizeof(buf));
175 if((ptr = strchr(buf, '\r')))
182 unsigned int bitfield_to_int(const void *bitfield, size_t size) {
183 unsigned int value = 0;
184 if(size > sizeof(value))
185 size = sizeof(value);
186 memcpy(&value, bitfield, size);