blob: 3411286c974be08bb1464dd2ba9fb83fa71ac912 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
|
#include "picohttp_base64.h"
void phb64encode(
phb64raw_t const raw,
size_t count,
phb64enc_t enc)
{
enc[1] = 0;
enc[3] = 0xff;
enc[2] = (count > 1) ? 0 : 0xff;
switch(count) {
default:
return;
case 3:
enc[3] = ((raw[2] & 0x3f));
enc[2] = ((raw[2] & 0xc0) >> 6);
case 2:
enc[2] |= ((raw[1] & 0x0f) << 2);
enc[1] = ((raw[1] & 0xf0) >> 4);
case 1:
enc[1] |= ((raw[0] & 0x03) << 4);
enc[0] = ((raw[0] & 0xfc) >> 2);
}
for(int i = 0; i < 4; i++) {
if( 26 > enc[i] ) {
enc[i] = enc[i] + 'A';
} else
if( 52 > enc[i] ) {
enc[i] = (enc[i]-26) + 'a';
} else
if( 62 > enc[i] ) {
enc[i] = (enc[i]-52) + '0';
} else
switch( enc[i] ) {
case 62: enc[i] = '+'; break;
case 63: enc[i] = '/'; break;
default: enc[i] = '=';
}
}
}
size_t phb64decode(
phb64enc_t const enc,
phb64raw_t raw)
{
size_t count = 3;
phb64enc_t v;
for(int i = 0; i < 4; i++) {
if( 'A' <= enc[i] && 'Z' >= enc[i] ) {
v[i] = enc[i] - 'A';
} else
if( 'a' <= enc[i] && 'z' >= enc[i] ) {
v[i] = enc[i] - 'a' + 26;
} else
if( '0' <= enc[i] && '9' >= enc[i] ) {
v[i] = enc[i] - '0' + 52;
} else
switch(enc[i]) {
case '+': v[i] = 62; break;
case '/': v[i] = 63; break;
case 0: /* slightly deviating from the RFC, but reasonable */
case '=': v[i] = 0; count--; break;
default:
return 0;
}
}
raw[0] = ((v[0] & 0x3f) << 2) | ((v[1] & 0x30) >> 4);
raw[1] = ((v[1] & 0x0f) << 4) | ((v[2] & 0x3c) >> 2);
raw[2] = ((v[2] & 0x03) << 6) | ( v[3] & 0x3f );
return count;
}
|