]> git.meshlink.io Git - meshlink/blob - src/utils.c
Add missing mutex locks.
[meshlink] / src / utils.c
1 /*
2     utils.c -- gathering of some stupid small functions
3     Copyright (C) 2014 Guus Sliepen <guus@meshlink.io>
4
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.
9
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.
14
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.
18 */
19
20 #include "system.h"
21
22 #include "../src/logger.h"
23 #include "utils.h"
24
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,
45         };
46
47 static int charhex2bin(char c) {
48         if(isdigit(c)) {
49                 return c - '0';
50         } else {
51                 return toupper(c) - 'A' + 10;
52         }
53 }
54
55 int hex2bin(const char *src, void *vdst, int length) {
56         uint8_t *dst = vdst;
57         int i;
58
59         for(i = 0; i < length && isxdigit(src[i * 2]) && isxdigit(src[i * 2 + 1]); i++) {
60                 dst[i] = charhex2bin(src[i * 2]) * 16 + charhex2bin(src[i * 2 + 1]);
61         }
62
63         return i;
64 }
65
66 int bin2hex(const void *vsrc, char *dst, int length) {
67         const uint8_t *src = vsrc;
68
69         for(int i = length - 1; i >= 0; i--) {
70                 dst[i * 2 + 1] = hexadecimals[(unsigned char) src[i] & 15];
71                 dst[i * 2] = hexadecimals[(unsigned char) src[i] >> 4];
72         }
73
74         dst[length * 2] = 0;
75         return length * 2;
76 }
77
78 int b64decode(const char *src, void *dst, int length) {
79         int i;
80         uint32_t triplet = 0;
81         unsigned char *udst = dst;
82
83         for(i = 0; i < length / 3 * 4 && src[i]; i++) {
84                 triplet |= base64_decode[src[i] & 0xff] << (6 * (i & 3));
85
86                 if((i & 3) == 3) {
87                         if(triplet & 0xff000000U) {
88                                 return 0;
89                         }
90
91                         udst[0] = triplet & 0xff;
92                         triplet >>= 8;
93                         udst[1] = triplet & 0xff;
94                         triplet >>= 8;
95                         udst[2] = triplet;
96                         triplet = 0;
97                         udst += 3;
98                 }
99         }
100
101         if(triplet & 0xff000000U) {
102                 return 0;
103         }
104
105         if((i & 3) == 3) {
106                 udst[0] = triplet & 0xff;
107                 triplet >>= 8;
108                 udst[1] = triplet & 0xff;
109                 return i / 4 * 3 + 2;
110         } else if((i & 3) == 2) {
111                 udst[0] = triplet & 0xff;
112                 return i / 4 * 3 + 1;
113         } else {
114                 return i / 4 * 3;
115         }
116 }
117
118 static int b64encode_internal(const void *src, char *dst, int length, const char *alphabet) {
119         uint32_t triplet;
120         const unsigned char *usrc = src;
121         int si = length / 3 * 3;
122         int di = length / 3 * 4;
123
124         switch(length % 3) {
125         case 2:
126                 triplet = usrc[si] | usrc[si + 1] << 8;
127                 dst[di] = alphabet[triplet & 63];
128                 triplet >>= 6;
129                 dst[di + 1] = alphabet[triplet & 63];
130                 triplet >>= 6;
131                 dst[di + 2] = alphabet[triplet];
132                 dst[di + 3] = 0;
133                 length = di + 2;
134                 break;
135
136         case 1:
137                 triplet = usrc[si];
138                 dst[di] = alphabet[triplet & 63];
139                 triplet >>= 6;
140                 dst[di + 1] = alphabet[triplet];
141                 dst[di + 2] = 0;
142                 length = di + 1;
143                 break;
144
145         default:
146                 dst[di] = 0;
147                 length = di;
148                 break;
149         }
150
151         while(si > 0) {
152                 di -= 4;
153                 si -= 3;
154                 triplet = usrc[si] | usrc[si + 1] << 8 | usrc[si + 2] << 16;
155                 dst[di] = alphabet[triplet & 63];
156                 triplet >>= 6;
157                 dst[di + 1] = alphabet[triplet & 63];
158                 triplet >>= 6;
159                 dst[di + 2] = alphabet[triplet & 63];
160                 triplet >>= 6;
161                 dst[di + 3] = alphabet[triplet];
162         }
163
164         return length;
165 }
166
167 int b64encode(const void *src, char *dst, int length) {
168         return b64encode_internal(src, dst, length, base64_original);
169 }
170
171 int b64encode_urlsafe(const void *src, char *dst, int length) {
172         return b64encode_internal(src, dst, length, base64_urlsafe);
173 }
174
175 #if defined(HAVE_MINGW) || defined(HAVE_CYGWIN)
176 #ifdef HAVE_CYGWIN
177 #include <w32api/windows.h>
178 #endif
179
180 const char *winerror(int err) {
181         char buf[1024], *ptr;
182
183         ptr = buf + sprintf(buf, "(%d) ", err);
184
185         if(!FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM | FORMAT_MESSAGE_IGNORE_INSERTS, NULL, err, MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), ptr, sizeof(buf) - (ptr - buf), NULL)) {
186                 strncpy(buf, "(unable to format errormessage)", sizeof(buf));
187         }
188
189         if((ptr = strchr(buf, '\r'))) {
190                 *ptr = '\0';
191         }
192
193         return buf;
194 }
195 #endif
196
197 unsigned int bitfield_to_int(const void *bitfield, size_t size) {
198         unsigned int value = 0;
199
200         if(size > sizeof(value)) {
201                 size = sizeof(value);
202         }
203
204         memcpy(&value, bitfield, size);
205         return value;
206 }