From 871a3c76968128c2e09d1db9dd7b0a50704b9036 Mon Sep 17 00:00:00 2001 From: "git@daemon.de" Date: Thu, 30 Jan 2014 20:44:27 +0100 Subject: [PATCH] added --- libpcp/base85.c | 113 ++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 113 insertions(+) create mode 100644 libpcp/base85.c diff --git a/libpcp/base85.c b/libpcp/base85.c new file mode 100644 index 0000000..c8cbf49 --- /dev/null +++ b/libpcp/base85.c @@ -0,0 +1,113 @@ +/* + +Source from GIT +Licensed under the terms of the LGPL 2.1. + +*/ + +#include "base85.h" + +static const char en85[] = { + '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', + 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', + 'K', 'L', 'M', 'N', 'O', 'P', 'Q', 'R', 'S', 'T', + 'U', 'V', 'W', 'X', 'Y', 'Z', + 'a', 'b', 'c', 'd', 'e', 'f', 'g', 'h', 'i', 'j', + 'k', 'l', 'm', 'n', 'o', 'p', 'q', 'r', 's', 't', + 'u', 'v', 'w', 'x', 'y', 'z', + '!', '#', '$', '%', '&', '(', ')', '*', '+', '-', + ';', '<', '=', '>', '?', '@', '^', '_', '`', '{', + '|', '}', '~' +}; + +static char de85[256]; + +static void prep_base85(void) +{ + int i; + if (de85['Z']) + return; + for (i = 0; i < ARRAY_SIZE(en85); i++) { + int ch = en85[i]; + de85[ch] = i + 1; + } +} + +int decode_85(char *dst, const char *buffer, int len) +{ + prep_base85(); + + say1("len: %d\n", len); + say2("decode 85 <%.*s>\n", len / 4 * 5, buffer); + while (len) { + unsigned acc = 0; + int de, cnt = 4; + unsigned char ch; + do { + ch = *buffer++; + de = de85[ch]; + if (--de < 0) + return error("invalid base85 alphabet <%c>\n", ch); + acc = acc * 85 + de; + } while (--cnt); + ch = *buffer++; + de = de85[ch]; + if (--de < 0) + return error("invalid base85 alphabet <%c>\n", ch); + + + /* Detect overflow. */ + if (0xffffffff / 85 < acc || + 0xffffffff - de < (acc *= 85)) + return error("invalid base85 sequence %.5s => %08x\n", buffer-5, acc); + acc += de; + // say1(" %08x\n", acc); + say1("%.5s", buffer-5); + say2("=> %08x (len: %d)\n", acc, len); + + cnt = (len < 4) ? len : 4; + len -= cnt; + do { + acc = (acc << 8) | (acc >> 24); + *dst++ = acc; + } while (--cnt); + } + say("\n"); + + return 0; +} + +void encode_85(char *buf, const unsigned char *data, int bytes) +{ + say("encode 85\n"); + + int pad = bytes % 4; + if(pad > 0) { + pad = 4 - pad; + say1("pad: %d\n", pad); + data = realloc((void *)data, bytes + pad); + memset((void *)&data[bytes], 0, pad); + } + + while (bytes) { + unsigned acc = 0; + int cnt; + for (cnt = 24; cnt >= 0; cnt -= 8) { + unsigned ch = *data++; + acc |= ch << cnt; + if (--bytes == 0) + break; + } + say1(" %08x", acc); + for (cnt = 4; cnt >= 0; cnt--) { + int val = acc % 85; + acc /= 85; + buf[cnt] = en85[val]; + } + say1(" => %.5s\n", buf); + buf += 5; + } + say("\n"); + + *buf = 0; +}