2 utils.c -- gathering of some stupid small functions
3 Copyright (C) 1999-2005 Ivo Timmermans
4 2000-2009 Guus Sliepen <guus@tinc-vpn.org>
6 This program is free software; you can redistribute it and/or modify
7 it under the terms of the GNU General Public License as published by
8 the Free Software Foundation; either version 2 of the License, or
9 (at your option) any later version.
11 This program is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License along
17 with this program; if not, write to the Free Software Foundation, Inc.,
18 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #include "../src/logger.h"
26 static const char hexadecimals[] = "0123456789ABCDEF";
27 static const char base64imals[] = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
29 static int charhex2bin(char c) {
33 return toupper(c) - 'A' + 10;
36 static int charb64decode(char c) {
49 void hex2bin(char *src, char *dst, int length) {
51 for(i = 0; i < length; i++)
52 dst[i] = charhex2bin(src[i * 2]) * 16 + charhex2bin(src[i * 2 + 1]);
55 void bin2hex(char *src, char *dst, int length) {
57 for(i = length - 1; i >= 0; i--) {
58 dst[i * 2 + 1] = hexadecimals[(unsigned char) src[i] & 15];
59 dst[i * 2] = hexadecimals[(unsigned char) src[i] >> 4];
63 int b64decode(const char *src, char *dst, int length) {
65 unsigned char *udst = dst;
67 for(int i = 0; i < length; i++) {
68 triplet |= charb64decode(src[i]) << (6 * (i & 3));
70 udst[0] = triplet & 0xff; triplet >>= 8;
71 udst[1] = triplet & 0xff; triplet >>= 8;
77 if((length & 3) == 3) {
78 udst[0] = triplet & 0xff; triplet >>= 8;
79 udst[1] = triplet & 0xff;
80 return length / 4 * 3 + 2;
81 } else if((length & 3) == 2) {
82 udst[0] = triplet & 0xff;
83 return length / 4 * 3 + 1;
85 return length / 4 * 3;
89 int b64encode(const char *src, char *dst, int length) {
91 const unsigned char *usrc = src;
96 triplet = usrc[0] | usrc[1] << 8 | usrc[2] << 16;
97 dst[0] = base64imals[triplet & 63]; triplet >>= 6;
98 dst[1] = base64imals[triplet & 63]; triplet >>= 6;
99 dst[2] = base64imals[triplet & 63]; triplet >>= 6;
100 dst[3] = base64imals[triplet];
101 dst += 4; usrc += 3; length -= 3;
102 } else if(length >=2) {
103 triplet = usrc[0] | usrc[1] << 8;
104 dst[0] = base64imals[triplet & 63]; triplet >>= 6;
105 dst[1] = base64imals[triplet & 63]; triplet >>= 6;
106 dst[2] = base64imals[triplet];
108 return origlen / 3 * 4 + 3;
111 dst[0] = base64imals[triplet & 63]; triplet >>= 6;
112 dst[1] = base64imals[triplet];
114 return origlen / 3 * 4 + 2;
119 return origlen / 4 * 3;
122 #if defined(HAVE_MINGW) || defined(HAVE_CYGWIN)
124 #include <w32api/windows.h>
127 const char *winerror(int err) {
128 static char buf[1024], *newline;
130 if (!FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM | FORMAT_MESSAGE_IGNORE_INSERTS,
131 NULL, err, MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof(buf), NULL)) {
132 strncpy(buf, "(unable to format errormessage)", sizeof(buf));
135 if((newline = strchr(buf, '\r')))
142 unsigned int bitfield_to_int(const void *bitfield, size_t size) {
143 unsigned int value = 0;
144 if(size > sizeof value)
146 memcpy(&value, bitfield, size);