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
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
|
#if defined(__linux__)
#include <linux/errno.h>
#else
#include <sys/errno.h>
#endif
/*
* base64 encode/decode.
*/
const char *pem_key = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
static int encode_bits(int c)
{
return pem_key[c];
}
static int decode_bits(char c)
{
if (c >= 'A' && c <= 'Z')
return c - 'A';
if (c >= 'a' && c <= 'z')
return c - 'a' + 26;
if (c >= '0' && c <= '9')
return c - '0' + 52;
if (c == '+' || c == '-')
return 62;
if (c == '/' || c == '_')
return 63;
if (c == '=')
return 0; /* just non-negative, please */
return -EINVAL;
}
static int set_str_val(char **pdst, const char *end, char c)
{
if (*pdst < end) {
char *p = *pdst;
*p = c;
(*pdst)++;
} else
return -ERANGE;
return 0;
}
int ceph_armor_line_break(char *dst, const char *dst_end, const char *src, const char *end, int line_width)
{
int olen = 0;
int line = 0;
#define SET_DST(c) do { \
int __ret = set_str_val(&dst, dst_end, c); \
if (__ret < 0) \
return __ret; \
} while (0);
while (src < end) {
unsigned char a;
a = *src++;
SET_DST(encode_bits(a >> 2));
if (src < end) {
unsigned char b;
b = *src++;
SET_DST(encode_bits(((a & 3) << 4) | (b >> 4)));
if (src < end) {
unsigned char c;
c = *src++;
SET_DST(encode_bits(((b & 15) << 2) |
(c >> 6)));
SET_DST(encode_bits(c & 63));
} else {
SET_DST(encode_bits((b & 15) << 2));
SET_DST('=');
}
} else {
SET_DST(encode_bits(((a & 3) << 4)));
SET_DST('=');
SET_DST('=');
}
olen += 4;
line += 4;
if (line_width && line == line_width) {
line = 0;
SET_DST('\n');
olen++;
}
}
return olen;
}
int ceph_armor(char *dst, const char *dst_end, const char *src, const char *end)
{
return ceph_armor_line_break(dst, dst_end, src, end, 0);
}
int ceph_unarmor(char *dst, const char *dst_end, const char *src, const char *end)
{
int olen = 0;
while (src < end) {
int a, b, c, d;
if (src[0] == '\n') {
src++;
continue;
}
if (src + 4 > end)
return -EINVAL;
a = decode_bits(src[0]);
b = decode_bits(src[1]);
c = decode_bits(src[2]);
d = decode_bits(src[3]);
if (a < 0 || b < 0 || c < 0 || d < 0)
return -EINVAL;
SET_DST((a << 2) | (b >> 4));
if (src[2] == '=')
return olen + 1;
SET_DST(((b & 15) << 4) | (c >> 2));
if (src[3] == '=')
return olen + 2;
SET_DST(((c & 3) << 6) | d);
olen += 3;
src += 4;
}
return olen;
}
|
