File: tmate-msgpack.c

package info (click to toggle)
tmate-ssh-server 2.3.0-49-g97d20249-1
  • links: PTS, VCS
  • area: main
  • in suites: bullseye
  • size: 2,520 kB
  • sloc: ansic: 39,208; awk: 339; makefile: 252; sh: 126; ruby: 45; perl: 41
file content (308 lines) | stat: -rw-r--r-- 7,202 bytes parent folder | download
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
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
#include "tmate.h"
#include "tmate-protocol.h"

static void on_encoder_buffer_ready(__unused evutil_socket_t fd,
				    __unused short what, void *arg)
{
	struct tmate_encoder *encoder = arg;

	encoder->ev_active = false;
	encoder->ready_callback(encoder->userdata, encoder->buffer);
}

static int on_encoder_write(void *userdata, const char *buf, size_t len)
{
	struct tmate_encoder *encoder = userdata;

	if (evbuffer_add(encoder->buffer, buf, len) < 0)
		tmate_fatal("Cannot buffer encoded data");

	if (!encoder->ev_active) {
		event_active(&encoder->ev_buffer, EV_READ, 0);
		encoder->ev_active = true;
	}

	return 0;
}

/* Really sad hack, but we can get away with it */
#define tmate_encoder_from_pk(pk) ((struct tmate_encoder *)pk)

void msgpack_pack_string(msgpack_packer *pk, const char *str)
{
	size_t len = strlen(str);

	if (tmate_encoder_from_pk(pk)->mpac_version >= 5) {
		msgpack_pack_str(pk, len);
		msgpack_pack_str_body(pk, str, len);
	} else {
		msgpack_pack_v4raw(pk, len);
		msgpack_pack_v4raw_body(pk, str, len);
	}
}

void msgpack_pack_boolean(msgpack_packer *pk, bool value)
{
	if (value)
		msgpack_pack_true(pk);
	else
		msgpack_pack_false(pk);
}

/* Copy/pasted from msgpack sources, except we include the v4 support */
int _msgpack_pack_object(msgpack_packer* pk, msgpack_object d)
{
	switch(d.type) {
		case MSGPACK_OBJECT_NIL:
			return msgpack_pack_nil(pk);

		case MSGPACK_OBJECT_BOOLEAN:
			if(d.via.boolean) {
				return msgpack_pack_true(pk);
			} else {
				return msgpack_pack_false(pk);
			}

		case MSGPACK_OBJECT_POSITIVE_INTEGER:
			return msgpack_pack_uint64(pk, d.via.u64);

		case MSGPACK_OBJECT_NEGATIVE_INTEGER:
			return msgpack_pack_int64(pk, d.via.i64);

		case MSGPACK_OBJECT_FLOAT:
			return msgpack_pack_double(pk, d.via.f64);

		case MSGPACK_OBJECT_STR:
			{
				/* XXX using bin types anyway! */
				if (tmate_encoder_from_pk(pk)->mpac_version >= 5) {
					int ret = msgpack_pack_bin(pk, d.via.str.size);
					if(ret < 0) { return ret; }
					return msgpack_pack_bin_body(pk, d.via.str.ptr, d.via.str.size);
				} else {
					int ret = msgpack_pack_v4raw(pk, d.via.str.size);
					if(ret < 0) { return ret; }
					return msgpack_pack_v4raw_body(pk, d.via.str.ptr, d.via.str.size);
				}
			}

		case MSGPACK_OBJECT_BIN:
			{
				if (tmate_encoder_from_pk(pk)->mpac_version >= 5) {
					int ret = msgpack_pack_bin(pk, d.via.bin.size);
					if(ret < 0) { return ret; }
					return msgpack_pack_bin_body(pk, d.via.bin.ptr, d.via.bin.size);
				} else {
					int ret = msgpack_pack_v4raw(pk, d.via.bin.size);
					if(ret < 0) { return ret; }
					return msgpack_pack_v4raw_body(pk, d.via.bin.ptr, d.via.bin.size);
				}
			}

		case MSGPACK_OBJECT_EXT:
			{
				int ret = msgpack_pack_ext(pk, d.via.ext.size, d.via.ext.type);
				if(ret < 0) { return ret; }
				return msgpack_pack_ext_body(pk, d.via.ext.ptr, d.via.ext.size);
			}

		case MSGPACK_OBJECT_ARRAY:
			{
				int ret = msgpack_pack_array(pk, d.via.array.size);
				if(ret < 0) {
					return ret;
				}
				else {
					msgpack_object* o = d.via.array.ptr;
					msgpack_object* const oend = d.via.array.ptr + d.via.array.size;
					for(; o != oend; ++o) {
						ret = msgpack_pack_object(pk, *o);
						if(ret < 0) { return ret; }
					}

					return 0;
				}
			}

		case MSGPACK_OBJECT_MAP:
			{
				int ret = msgpack_pack_map(pk, d.via.map.size);
				if(ret < 0) {
					return ret;
				}
				else {
					msgpack_object_kv* kv = d.via.map.ptr;
					msgpack_object_kv* const kvend = d.via.map.ptr + d.via.map.size;
					for(; kv != kvend; ++kv) {
						ret = msgpack_pack_object(pk, kv->key);
						if(ret < 0) { return ret; }
						ret = msgpack_pack_object(pk, kv->val);
						if(ret < 0) { return ret; }
					}

					return 0;
				}
			}

		default:
			return -1;
	}
}

void tmate_encoder_init(struct tmate_encoder *encoder,
			tmate_encoder_write_cb *callback,
			void *userdata)
{
	msgpack_packer_init(&encoder->pk, encoder, &on_encoder_write);
	encoder->mpac_version = 5;
	encoder->buffer = evbuffer_new();
	encoder->ready_callback = callback;
	encoder->userdata = userdata;

	if (!encoder->buffer)
		tmate_fatal("Can't allocate buffer");

	event_set(&encoder->ev_buffer, -1,
		  EV_READ | EV_PERSIST, on_encoder_buffer_ready, encoder);

	event_add(&encoder->ev_buffer, NULL);

	encoder->ev_active = false;
}

void tmate_decoder_error(void)
{
	tmate_print_stack_trace();
	tmate_fatal("Received a bad message");
}

void init_unpacker(struct tmate_unpacker *uk, msgpack_object obj)
{
	if (obj.type != MSGPACK_OBJECT_ARRAY)
		tmate_decoder_error();

	uk->argv = obj.via.array.ptr;
	uk->argc = obj.via.array.size;
}

int64_t unpack_int(struct tmate_unpacker *uk)
{
	int64_t val;

	if (uk->argc == 0)
		tmate_decoder_error();

	if (uk->argv[0].type != MSGPACK_OBJECT_POSITIVE_INTEGER &&
	    uk->argv[0].type != MSGPACK_OBJECT_NEGATIVE_INTEGER)
		tmate_decoder_error();

	val = uk->argv[0].via.i64;

	uk->argv++;
	uk->argc--;

	return val;
}

bool unpack_bool(struct tmate_unpacker *uk)
{
	bool val;

	if (uk->argc == 0)
		tmate_decoder_error();

	if (uk->argv[0].type != MSGPACK_OBJECT_BOOLEAN)
		tmate_decoder_error();

	val = uk->argv[0].via.boolean;

	uk->argv++;
	uk->argc--;

	return val;
}

void unpack_buffer(struct tmate_unpacker *uk, const char **buf, size_t *len)
{
	if (uk->argc == 0)
		tmate_decoder_error();

	if (uk->argv[0].type != MSGPACK_OBJECT_STR &&
	    uk->argv[0].type != MSGPACK_OBJECT_BIN)
		tmate_decoder_error();

	*len = uk->argv[0].via.str.size;
	*buf = uk->argv[0].via.str.ptr;

	uk->argv++;
	uk->argc--;
}

char *unpack_string(struct tmate_unpacker *uk)
{
	const char *buf;
	char *alloc_buf;
	size_t len;

	unpack_buffer(uk, &buf, &len);

	alloc_buf = xmalloc(len + 1);
	memcpy(alloc_buf, buf, len);
	alloc_buf[len] = '\0';

	return alloc_buf;
}

void unpack_array(struct tmate_unpacker *uk, struct tmate_unpacker *nested)
{
	if (uk->argc == 0)
		tmate_decoder_error();

	init_unpacker(nested, uk->argv[0]);

	uk->argv++;
	uk->argc--;
}

msgpack_object_type unpack_peek_type(struct tmate_unpacker *uk)
{
	if (uk->argc == 0)
		tmate_decoder_error();
	return uk->argv[0].type;
}

#define UNPACKER_RESERVE_SIZE 1024

void tmate_decoder_init(struct tmate_decoder *decoder, tmate_decoder_reader *reader,
			void *userdata)
{
	if (!msgpack_unpacker_init(&decoder->unpacker, UNPACKER_RESERVE_SIZE))
		tmate_fatal("Cannot initialize the unpacker");
	decoder->reader = reader;
	decoder->userdata = userdata;
}

void tmate_decoder_get_buffer(struct tmate_decoder *decoder,
			      char **buf, size_t *len)
{
	if (!msgpack_unpacker_reserve_buffer(&decoder->unpacker, UNPACKER_RESERVE_SIZE))
		tmate_fatal("cannot expand decoder buffer");

	*buf = msgpack_unpacker_buffer(&decoder->unpacker);
	*len = msgpack_unpacker_buffer_capacity(&decoder->unpacker);
}

void tmate_decoder_commit(struct tmate_decoder *decoder, size_t len)
{
	struct tmate_unpacker _uk, *uk = &_uk;
	msgpack_unpacked result;

	msgpack_unpacker_buffer_consumed(&decoder->unpacker, len);

	msgpack_unpacked_init(&result);
	while (msgpack_unpacker_next(&decoder->unpacker, &result)) {
		init_unpacker(uk, result.data);
		decoder->reader(decoder->userdata, uk);
	}
	msgpack_unpacked_destroy(&result);
}