]>
Commit | Line | Data |
---|---|---|
ace51c4d EVH |
1 | /* |
2 | * net/9p/protocol.c | |
3 | * | |
4 | * 9P Protocol Support Code | |
5 | * | |
6 | * Copyright (C) 2008 by Eric Van Hensbergen <ericvh@gmail.com> | |
7 | * | |
8 | * Base on code from Anthony Liguori <aliguori@us.ibm.com> | |
9 | * Copyright (C) 2008 by IBM, Corp. | |
10 | * | |
11 | * This program is free software; you can redistribute it and/or modify | |
12 | * it under the terms of the GNU General Public License version 2 | |
13 | * as published by the Free Software Foundation. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to: | |
22 | * Free Software Foundation | |
23 | * 51 Franklin Street, Fifth Floor | |
24 | * Boston, MA 02111-1301 USA | |
25 | * | |
26 | */ | |
27 | ||
28 | #include <linux/module.h> | |
29 | #include <linux/errno.h> | |
51a87c55 | 30 | #include <linux/uaccess.h> |
e7f4b8f1 | 31 | #include <linux/sched.h> |
beeebc92 | 32 | #include <linux/types.h> |
ace51c4d EVH |
33 | #include <net/9p/9p.h> |
34 | #include <net/9p/client.h> | |
35 | #include "protocol.h" | |
36 | ||
37 | #ifndef MIN | |
38 | #define MIN(a, b) (((a) < (b)) ? (a) : (b)) | |
39 | #endif | |
40 | ||
41 | #ifndef MAX | |
42 | #define MAX(a, b) (((a) > (b)) ? (a) : (b)) | |
43 | #endif | |
44 | ||
45 | #ifndef offset_of | |
46 | #define offset_of(type, memb) \ | |
47 | ((unsigned long)(&((type *)0)->memb)) | |
48 | #endif | |
49 | #ifndef container_of | |
50 | #define container_of(obj, type, memb) \ | |
51 | ((type *)(((char *)obj) - offset_of(type, memb))) | |
52 | #endif | |
53 | ||
54 | static int | |
55 | p9pdu_writef(struct p9_fcall *pdu, int optional, const char *fmt, ...); | |
56 | ||
0b15a3a5 | 57 | #ifdef CONFIG_NET_9P_DEBUG |
51a87c55 EVH |
58 | void |
59 | p9pdu_dump(int way, struct p9_fcall *pdu) | |
60 | { | |
61 | int i, n; | |
62 | u8 *data = pdu->sdata; | |
63 | int datalen = pdu->size; | |
64 | char buf[255]; | |
65 | int buflen = 255; | |
66 | ||
67 | i = n = 0; | |
68 | if (datalen > (buflen-16)) | |
69 | datalen = buflen-16; | |
70 | while (i < datalen) { | |
71 | n += scnprintf(buf + n, buflen - n, "%02x ", data[i]); | |
72 | if (i%4 == 3) | |
73 | n += scnprintf(buf + n, buflen - n, " "); | |
74 | if (i%32 == 31) | |
75 | n += scnprintf(buf + n, buflen - n, "\n"); | |
76 | ||
77 | i++; | |
78 | } | |
79 | n += scnprintf(buf + n, buflen - n, "\n"); | |
80 | ||
81 | if (way) | |
e7f4b8f1 | 82 | P9_DPRINTK(P9_DEBUG_PKT, "[[[(%d) %s\n", datalen, buf); |
51a87c55 | 83 | else |
e7f4b8f1 | 84 | P9_DPRINTK(P9_DEBUG_PKT, "]]](%d) %s\n", datalen, buf); |
51a87c55 | 85 | } |
0b15a3a5 EVH |
86 | #else |
87 | void | |
88 | p9pdu_dump(int way, struct p9_fcall *pdu) | |
89 | { | |
90 | } | |
91 | #endif | |
51a87c55 EVH |
92 | EXPORT_SYMBOL(p9pdu_dump); |
93 | ||
ace51c4d EVH |
94 | void p9stat_free(struct p9_wstat *stbuf) |
95 | { | |
96 | kfree(stbuf->name); | |
97 | kfree(stbuf->uid); | |
98 | kfree(stbuf->gid); | |
99 | kfree(stbuf->muid); | |
100 | kfree(stbuf->extension); | |
101 | } | |
102 | EXPORT_SYMBOL(p9stat_free); | |
103 | ||
104 | static size_t pdu_read(struct p9_fcall *pdu, void *data, size_t size) | |
105 | { | |
106 | size_t len = MIN(pdu->size - pdu->offset, size); | |
107 | memcpy(data, &pdu->sdata[pdu->offset], len); | |
108 | pdu->offset += len; | |
109 | return size - len; | |
110 | } | |
111 | ||
112 | static size_t pdu_write(struct p9_fcall *pdu, const void *data, size_t size) | |
113 | { | |
114 | size_t len = MIN(pdu->capacity - pdu->size, size); | |
115 | memcpy(&pdu->sdata[pdu->size], data, len); | |
116 | pdu->size += len; | |
117 | return size - len; | |
118 | } | |
119 | ||
51a87c55 EVH |
120 | static size_t |
121 | pdu_write_u(struct p9_fcall *pdu, const char __user *udata, size_t size) | |
122 | { | |
123 | size_t len = MIN(pdu->capacity - pdu->size, size); | |
124 | int err = copy_from_user(&pdu->sdata[pdu->size], udata, len); | |
125 | if (err) | |
126 | printk(KERN_WARNING "pdu_write_u returning: %d\n", err); | |
127 | ||
128 | pdu->size += len; | |
129 | return size - len; | |
130 | } | |
131 | ||
ace51c4d EVH |
132 | /* |
133 | b - int8_t | |
134 | w - int16_t | |
135 | d - int32_t | |
136 | q - int64_t | |
137 | s - string | |
138 | S - stat | |
139 | Q - qid | |
140 | D - data blob (int32_t size followed by void *, results are not freed) | |
141 | T - array of strings (int16_t count, followed by strings) | |
142 | R - array of qids (int16_t count, followed by qids) | |
143 | ? - if optional = 1, continue parsing | |
144 | */ | |
145 | ||
146 | static int | |
147 | p9pdu_vreadf(struct p9_fcall *pdu, int optional, const char *fmt, va_list ap) | |
148 | { | |
149 | const char *ptr; | |
150 | int errcode = 0; | |
151 | ||
152 | for (ptr = fmt; *ptr; ptr++) { | |
153 | switch (*ptr) { | |
154 | case 'b':{ | |
155 | int8_t *val = va_arg(ap, int8_t *); | |
156 | if (pdu_read(pdu, val, sizeof(*val))) { | |
157 | errcode = -EFAULT; | |
158 | break; | |
159 | } | |
160 | } | |
161 | break; | |
162 | case 'w':{ | |
163 | int16_t *val = va_arg(ap, int16_t *); | |
beeebc92 EVH |
164 | __le16 le_val; |
165 | if (pdu_read(pdu, &le_val, sizeof(le_val))) { | |
ace51c4d EVH |
166 | errcode = -EFAULT; |
167 | break; | |
168 | } | |
beeebc92 | 169 | *val = le16_to_cpu(le_val); |
ace51c4d EVH |
170 | } |
171 | break; | |
172 | case 'd':{ | |
173 | int32_t *val = va_arg(ap, int32_t *); | |
beeebc92 EVH |
174 | __le32 le_val; |
175 | if (pdu_read(pdu, &le_val, sizeof(le_val))) { | |
ace51c4d EVH |
176 | errcode = -EFAULT; |
177 | break; | |
178 | } | |
beeebc92 | 179 | *val = le32_to_cpu(le_val); |
ace51c4d EVH |
180 | } |
181 | break; | |
182 | case 'q':{ | |
183 | int64_t *val = va_arg(ap, int64_t *); | |
beeebc92 EVH |
184 | __le64 le_val; |
185 | if (pdu_read(pdu, &le_val, sizeof(le_val))) { | |
ace51c4d EVH |
186 | errcode = -EFAULT; |
187 | break; | |
188 | } | |
beeebc92 | 189 | *val = le64_to_cpu(le_val); |
ace51c4d EVH |
190 | } |
191 | break; | |
192 | case 's':{ | |
e45c5405 | 193 | char **sptr = va_arg(ap, char **); |
ace51c4d EVH |
194 | int16_t len; |
195 | int size; | |
196 | ||
197 | errcode = p9pdu_readf(pdu, optional, "w", &len); | |
198 | if (errcode) | |
199 | break; | |
200 | ||
201 | size = MAX(len, 0); | |
202 | ||
e45c5405 EVH |
203 | *sptr = kmalloc(size + 1, GFP_KERNEL); |
204 | if (*sptr == NULL) { | |
ace51c4d EVH |
205 | errcode = -EFAULT; |
206 | break; | |
207 | } | |
e45c5405 | 208 | if (pdu_read(pdu, *sptr, size)) { |
ace51c4d | 209 | errcode = -EFAULT; |
e45c5405 EVH |
210 | kfree(*sptr); |
211 | *sptr = NULL; | |
ace51c4d | 212 | } else |
e45c5405 | 213 | (*sptr)[size] = 0; |
ace51c4d EVH |
214 | } |
215 | break; | |
216 | case 'Q':{ | |
217 | struct p9_qid *qid = | |
218 | va_arg(ap, struct p9_qid *); | |
219 | ||
220 | errcode = p9pdu_readf(pdu, optional, "bdq", | |
221 | &qid->type, &qid->version, | |
222 | &qid->path); | |
223 | } | |
224 | break; | |
225 | case 'S':{ | |
226 | struct p9_wstat *stbuf = | |
227 | va_arg(ap, struct p9_wstat *); | |
228 | ||
f0a0ac2e | 229 | memset(stbuf, 0, sizeof(struct p9_wstat)); |
ace51c4d | 230 | stbuf->n_uid = stbuf->n_gid = stbuf->n_muid = |
f0a0ac2e | 231 | -1; |
ace51c4d EVH |
232 | errcode = |
233 | p9pdu_readf(pdu, optional, | |
234 | "wwdQdddqssss?sddd", | |
235 | &stbuf->size, &stbuf->type, | |
236 | &stbuf->dev, &stbuf->qid, | |
237 | &stbuf->mode, &stbuf->atime, | |
238 | &stbuf->mtime, &stbuf->length, | |
239 | &stbuf->name, &stbuf->uid, | |
240 | &stbuf->gid, &stbuf->muid, | |
241 | &stbuf->extension, | |
242 | &stbuf->n_uid, &stbuf->n_gid, | |
243 | &stbuf->n_muid); | |
244 | if (errcode) | |
245 | p9stat_free(stbuf); | |
246 | } | |
247 | break; | |
248 | case 'D':{ | |
249 | int32_t *count = va_arg(ap, int32_t *); | |
250 | void **data = va_arg(ap, void **); | |
251 | ||
252 | errcode = | |
253 | p9pdu_readf(pdu, optional, "d", count); | |
254 | if (!errcode) { | |
255 | *count = | |
256 | MIN(*count, | |
257 | pdu->size - pdu->offset); | |
258 | *data = &pdu->sdata[pdu->offset]; | |
259 | } | |
260 | } | |
261 | break; | |
262 | case 'T':{ | |
263 | int16_t *nwname = va_arg(ap, int16_t *); | |
264 | char ***wnames = va_arg(ap, char ***); | |
265 | ||
266 | errcode = | |
267 | p9pdu_readf(pdu, optional, "w", nwname); | |
268 | if (!errcode) { | |
269 | *wnames = | |
270 | kmalloc(sizeof(char *) * *nwname, | |
271 | GFP_KERNEL); | |
272 | if (!*wnames) | |
273 | errcode = -ENOMEM; | |
274 | } | |
275 | ||
276 | if (!errcode) { | |
277 | int i; | |
278 | ||
279 | for (i = 0; i < *nwname; i++) { | |
280 | errcode = | |
281 | p9pdu_readf(pdu, optional, | |
282 | "s", | |
283 | &(*wnames)[i]); | |
284 | if (errcode) | |
285 | break; | |
286 | } | |
287 | } | |
288 | ||
289 | if (errcode) { | |
290 | if (*wnames) { | |
291 | int i; | |
292 | ||
293 | for (i = 0; i < *nwname; i++) | |
294 | kfree((*wnames)[i]); | |
295 | } | |
296 | kfree(*wnames); | |
297 | *wnames = NULL; | |
298 | } | |
299 | } | |
300 | break; | |
301 | case 'R':{ | |
302 | int16_t *nwqid = va_arg(ap, int16_t *); | |
303 | struct p9_qid **wqids = | |
304 | va_arg(ap, struct p9_qid **); | |
305 | ||
306 | *wqids = NULL; | |
307 | ||
308 | errcode = | |
309 | p9pdu_readf(pdu, optional, "w", nwqid); | |
310 | if (!errcode) { | |
311 | *wqids = | |
312 | kmalloc(*nwqid * | |
313 | sizeof(struct p9_qid), | |
314 | GFP_KERNEL); | |
315 | if (*wqids == NULL) | |
316 | errcode = -ENOMEM; | |
317 | } | |
318 | ||
319 | if (!errcode) { | |
320 | int i; | |
321 | ||
322 | for (i = 0; i < *nwqid; i++) { | |
323 | errcode = | |
324 | p9pdu_readf(pdu, optional, | |
325 | "Q", | |
326 | &(*wqids)[i]); | |
327 | if (errcode) | |
328 | break; | |
329 | } | |
330 | } | |
331 | ||
332 | if (errcode) { | |
333 | kfree(*wqids); | |
334 | *wqids = NULL; | |
335 | } | |
336 | } | |
337 | break; | |
338 | case '?': | |
339 | if (!optional) | |
340 | return 0; | |
341 | break; | |
342 | default: | |
343 | BUG(); | |
344 | break; | |
345 | } | |
346 | ||
347 | if (errcode) | |
348 | break; | |
349 | } | |
350 | ||
351 | return errcode; | |
352 | } | |
353 | ||
354 | int | |
355 | p9pdu_vwritef(struct p9_fcall *pdu, int optional, const char *fmt, va_list ap) | |
356 | { | |
357 | const char *ptr; | |
358 | int errcode = 0; | |
359 | ||
360 | for (ptr = fmt; *ptr; ptr++) { | |
361 | switch (*ptr) { | |
362 | case 'b':{ | |
363 | int8_t val = va_arg(ap, int); | |
364 | if (pdu_write(pdu, &val, sizeof(val))) | |
365 | errcode = -EFAULT; | |
366 | } | |
367 | break; | |
368 | case 'w':{ | |
beeebc92 | 369 | __le16 val = cpu_to_le16(va_arg(ap, int)); |
ace51c4d EVH |
370 | if (pdu_write(pdu, &val, sizeof(val))) |
371 | errcode = -EFAULT; | |
372 | } | |
373 | break; | |
374 | case 'd':{ | |
beeebc92 | 375 | __le32 val = cpu_to_le32(va_arg(ap, int32_t)); |
ace51c4d EVH |
376 | if (pdu_write(pdu, &val, sizeof(val))) |
377 | errcode = -EFAULT; | |
378 | } | |
379 | break; | |
380 | case 'q':{ | |
beeebc92 | 381 | __le64 val = cpu_to_le64(va_arg(ap, int64_t)); |
ace51c4d EVH |
382 | if (pdu_write(pdu, &val, sizeof(val))) |
383 | errcode = -EFAULT; | |
384 | } | |
385 | break; | |
386 | case 's':{ | |
e45c5405 | 387 | const char *sptr = va_arg(ap, const char *); |
ace51c4d | 388 | int16_t len = 0; |
e45c5405 EVH |
389 | if (sptr) |
390 | len = MIN(strlen(sptr), USHORT_MAX); | |
ace51c4d EVH |
391 | |
392 | errcode = p9pdu_writef(pdu, optional, "w", len); | |
e45c5405 | 393 | if (!errcode && pdu_write(pdu, sptr, len)) |
ace51c4d EVH |
394 | errcode = -EFAULT; |
395 | } | |
396 | break; | |
397 | case 'Q':{ | |
398 | const struct p9_qid *qid = | |
399 | va_arg(ap, const struct p9_qid *); | |
400 | errcode = | |
401 | p9pdu_writef(pdu, optional, "bdq", | |
402 | qid->type, qid->version, | |
403 | qid->path); | |
404 | } break; | |
405 | case 'S':{ | |
406 | const struct p9_wstat *stbuf = | |
407 | va_arg(ap, const struct p9_wstat *); | |
408 | errcode = | |
409 | p9pdu_writef(pdu, optional, | |
410 | "wwdQdddqssss?sddd", | |
411 | stbuf->size, stbuf->type, | |
51a87c55 | 412 | stbuf->dev, &stbuf->qid, |
ace51c4d EVH |
413 | stbuf->mode, stbuf->atime, |
414 | stbuf->mtime, stbuf->length, | |
415 | stbuf->name, stbuf->uid, | |
416 | stbuf->gid, stbuf->muid, | |
417 | stbuf->extension, stbuf->n_uid, | |
418 | stbuf->n_gid, stbuf->n_muid); | |
419 | } break; | |
420 | case 'D':{ | |
421 | int32_t count = va_arg(ap, int32_t); | |
422 | const void *data = va_arg(ap, const void *); | |
423 | ||
424 | errcode = | |
425 | p9pdu_writef(pdu, optional, "d", count); | |
426 | if (!errcode && pdu_write(pdu, data, count)) | |
427 | errcode = -EFAULT; | |
428 | } | |
429 | break; | |
51a87c55 EVH |
430 | case 'U':{ |
431 | int32_t count = va_arg(ap, int32_t); | |
432 | const char __user *udata = | |
e45c5405 | 433 | va_arg(ap, const void __user *); |
51a87c55 EVH |
434 | errcode = |
435 | p9pdu_writef(pdu, optional, "d", count); | |
436 | if (!errcode && pdu_write_u(pdu, udata, count)) | |
437 | errcode = -EFAULT; | |
438 | } | |
439 | break; | |
ace51c4d EVH |
440 | case 'T':{ |
441 | int16_t nwname = va_arg(ap, int); | |
442 | const char **wnames = va_arg(ap, const char **); | |
443 | ||
444 | errcode = | |
445 | p9pdu_writef(pdu, optional, "w", nwname); | |
446 | if (!errcode) { | |
447 | int i; | |
448 | ||
449 | for (i = 0; i < nwname; i++) { | |
450 | errcode = | |
451 | p9pdu_writef(pdu, optional, | |
452 | "s", | |
453 | wnames[i]); | |
454 | if (errcode) | |
455 | break; | |
456 | } | |
457 | } | |
458 | } | |
459 | break; | |
460 | case 'R':{ | |
461 | int16_t nwqid = va_arg(ap, int); | |
462 | struct p9_qid *wqids = | |
463 | va_arg(ap, struct p9_qid *); | |
464 | ||
465 | errcode = | |
466 | p9pdu_writef(pdu, optional, "w", nwqid); | |
467 | if (!errcode) { | |
468 | int i; | |
469 | ||
470 | for (i = 0; i < nwqid; i++) { | |
471 | errcode = | |
472 | p9pdu_writef(pdu, optional, | |
473 | "Q", | |
474 | &wqids[i]); | |
475 | if (errcode) | |
476 | break; | |
477 | } | |
478 | } | |
479 | } | |
480 | break; | |
481 | case '?': | |
482 | if (!optional) | |
483 | return 0; | |
484 | break; | |
485 | default: | |
486 | BUG(); | |
487 | break; | |
488 | } | |
489 | ||
490 | if (errcode) | |
491 | break; | |
492 | } | |
493 | ||
494 | return errcode; | |
495 | } | |
496 | ||
497 | int p9pdu_readf(struct p9_fcall *pdu, int optional, const char *fmt, ...) | |
498 | { | |
499 | va_list ap; | |
500 | int ret; | |
501 | ||
502 | va_start(ap, fmt); | |
503 | ret = p9pdu_vreadf(pdu, optional, fmt, ap); | |
504 | va_end(ap); | |
505 | ||
506 | return ret; | |
507 | } | |
508 | ||
509 | static int | |
510 | p9pdu_writef(struct p9_fcall *pdu, int optional, const char *fmt, ...) | |
511 | { | |
512 | va_list ap; | |
513 | int ret; | |
514 | ||
515 | va_start(ap, fmt); | |
516 | ret = p9pdu_vwritef(pdu, optional, fmt, ap); | |
517 | va_end(ap); | |
518 | ||
519 | return ret; | |
520 | } | |
51a87c55 | 521 | |
02da398b EVH |
522 | int p9stat_read(char *buf, int len, struct p9_wstat *st, int dotu) |
523 | { | |
524 | struct p9_fcall fake_pdu; | |
e7f4b8f1 | 525 | int ret; |
02da398b EVH |
526 | |
527 | fake_pdu.size = len; | |
528 | fake_pdu.capacity = len; | |
529 | fake_pdu.sdata = buf; | |
530 | fake_pdu.offset = 0; | |
531 | ||
e7f4b8f1 EVH |
532 | ret = p9pdu_readf(&fake_pdu, dotu, "S", st); |
533 | if (ret) { | |
534 | P9_DPRINTK(P9_DEBUG_9P, "<<< p9stat_read failed: %d\n", ret); | |
535 | p9pdu_dump(1, &fake_pdu); | |
536 | } | |
537 | ||
538 | return ret; | |
02da398b EVH |
539 | } |
540 | EXPORT_SYMBOL(p9stat_read); | |
541 | ||
51a87c55 EVH |
542 | int p9pdu_prepare(struct p9_fcall *pdu, int16_t tag, int8_t type) |
543 | { | |
544 | return p9pdu_writef(pdu, 0, "dbw", 0, type, tag); | |
545 | } | |
546 | ||
547 | int p9pdu_finalize(struct p9_fcall *pdu) | |
548 | { | |
549 | int size = pdu->size; | |
550 | int err; | |
551 | ||
552 | pdu->size = 0; | |
553 | err = p9pdu_writef(pdu, 0, "d", size); | |
554 | pdu->size = size; | |
555 | ||
0b15a3a5 | 556 | #ifdef CONFIG_NET_9P_DEBUG |
e7f4b8f1 | 557 | if ((p9_debug_level & P9_DEBUG_PKT) == P9_DEBUG_PKT) |
51a87c55 | 558 | p9pdu_dump(0, pdu); |
0b15a3a5 | 559 | #endif |
51a87c55 | 560 | |
e7f4b8f1 EVH |
561 | P9_DPRINTK(P9_DEBUG_9P, ">>> size=%d type: %d tag: %d\n", pdu->size, |
562 | pdu->id, pdu->tag); | |
563 | ||
51a87c55 EVH |
564 | return err; |
565 | } | |
566 | ||
567 | void p9pdu_reset(struct p9_fcall *pdu) | |
568 | { | |
569 | pdu->offset = 0; | |
570 | pdu->size = 0; | |
571 | } |