X-Git-Url: http://git.meshlink.io/?a=blobdiff_plain;f=src%2Futils.c;h=e750450e8bc3cf203843378e99f123a7681f86f3;hb=19be9cf7150858311f7898fa3fb525d692d02f64;hp=6ea904a59d15a63803faee04c448e8e43665b4ad;hpb=79e9a4f743b7b59fed968575f6b36171cf4a0063;p=meshlink

diff --git a/src/utils.c b/src/utils.c
index 6ea904a5..e750450e 100644
--- a/src/utils.c
+++ b/src/utils.c
@@ -24,6 +24,7 @@
 #include "utils.h"
 
 static const char hexadecimals[] = "0123456789ABCDEF";
+static const char base64imals[] = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
 
 static int charhex2bin(char c) {
 	if(isdigit(c))
@@ -32,19 +33,102 @@ static int charhex2bin(char c) {
 		return toupper(c) - 'A' + 10;
 }
 
+static int charb64decode(char c) {
+	if(c >= 'a')
+		return c - 'a' + 26;
+	else if(c >= 'A')
+		return c - 'A';
+	else if(c >= '0') 
+		return c - '0' + 52;
+	else if(c == '+')
+		return 62;
+	else
+		return 63;
+}
 
-void hex2bin(char *src, char *dst, int length) {
+int hex2bin(const char *src, char *dst, int length) {
 	int i;
-	for(i = 0; i < length; i++)
+	for(i = 0; i < length && src[i * 2] && src[i * 2 + 1]; i++)
 		dst[i] = charhex2bin(src[i * 2]) * 16 + charhex2bin(src[i * 2 + 1]);
+	return i;
 }
 
-void bin2hex(char *src, char *dst, int length) {
+int bin2hex(const char *src, char *dst, int length) {
 	int i;
 	for(i = length - 1; i >= 0; i--) {
 		dst[i * 2 + 1] = hexadecimals[(unsigned char) src[i] & 15];
 		dst[i * 2] = hexadecimals[(unsigned char) src[i] >> 4];
 	}
+	dst[length * 2] = 0;
+	return length * 2;
+}
+
+int b64decode(const char *src, char *dst, int length) {
+	int i;
+	uint32_t triplet = 0;
+	unsigned char *udst = (unsigned char *)dst;
+
+	for(i = 0; i < length / 3 * 4 && src[i]; i++) {
+		triplet |= charb64decode(src[i]) << (6 * (i & 3));
+		if((i & 3) == 3) {
+			udst[0] = triplet & 0xff; triplet >>= 8;
+			udst[1] = triplet & 0xff; triplet >>= 8;
+			udst[2] = triplet;
+			triplet = 0;
+			udst += 3;
+		}
+	}
+	if((i & 3) == 3) {
+		udst[0] = triplet & 0xff; triplet >>= 8;
+		udst[1] = triplet & 0xff;
+		return i / 4 * 3 + 2;
+	} else if((i & 3) == 2) {
+		udst[0] = triplet & 0xff;
+		return i / 4 * 3 + 1;
+	} else {
+		return i / 4 * 3;
+	}
+}
+
+int b64encode(const char *src, char *dst, int length) {
+	uint32_t triplet;
+	const unsigned char *usrc = (unsigned char *)src;
+	int si = length / 3 * 3;
+	int di = length / 3 * 4;
+
+	switch(length % 3) {
+		case 2:	
+			triplet = usrc[si] | usrc[si + 1] << 8;
+			dst[di] = base64imals[triplet & 63]; triplet >>= 6;
+			dst[di + 1] = base64imals[triplet & 63]; triplet >>= 6;
+			dst[di + 2] = base64imals[triplet];
+			dst[di + 3] = 0;
+			length = di + 2;
+			break;
+		case 1:
+			triplet = usrc[si];
+			dst[di] = base64imals[triplet & 63]; triplet >>= 6;
+			dst[di + 1] = base64imals[triplet];
+			dst[di + 2] = 0;
+			length = di + 1;
+			break;
+		default:
+			dst[di] = 0;
+			length = di;
+			break;
+	}
+
+	while(si > 0) {
+		di -= 4;
+		si -= 3;
+		triplet = usrc[si] | usrc[si + 1] << 8 | usrc[si + 2] << 16;
+		dst[di] = base64imals[triplet & 63]; triplet >>= 6;
+		dst[di + 1] = base64imals[triplet & 63]; triplet >>= 6;
+		dst[di + 2] = base64imals[triplet & 63]; triplet >>= 6;
+		dst[di + 3] = base64imals[triplet];
+	}
+
+	return length;
 }
 
 #if defined(HAVE_MINGW) || defined(HAVE_CYGWIN)
@@ -53,15 +137,17 @@ void bin2hex(char *src, char *dst, int length) {
 #endif
 
 const char *winerror(int err) {
-	static char buf[1024], *newline;
+	static char buf[1024], *ptr;
+
+	ptr = buf + sprintf(buf, "(%d) ", err);
 
 	if (!FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM | FORMAT_MESSAGE_IGNORE_INSERTS,
-	        NULL, err, MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof(buf), NULL)) {
+	        NULL, err, MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), ptr, sizeof(buf) - (ptr - buf), NULL)) {
 		strncpy(buf, "(unable to format errormessage)", sizeof(buf));
 	};
 
-	if((newline = strchr(buf, '\r')))
-		*newline = '\0';
+	if((ptr = strchr(buf, '\r')))
+		*ptr = '\0';
 
 	return buf;
 }