xref: /openbmc/linux/net/9p/protocol.c (revision c819e2cf) 
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>
30 #include <linux/kernel.h>
31 #include <linux/uaccess.h>
32 #include <linux/slab.h>
33 #include <linux/sched.h>
34 #include <linux/stddef.h>
35 #include <linux/types.h>
36 #include <net/9p/9p.h>
37 #include <net/9p/client.h>
38 #include "protocol.h"
39 
40 #include <trace/events/9p.h>
41 
42 static int
43 p9pdu_writef(struct p9_fcall *pdu, int proto_version, const char *fmt, ...);
44 
45 void p9stat_free(struct p9_wstat *stbuf)
46 {
47 	kfree(stbuf->name);
48 	kfree(stbuf->uid);
49 	kfree(stbuf->gid);
50 	kfree(stbuf->muid);
51 	kfree(stbuf->extension);
52 }
53 EXPORT_SYMBOL(p9stat_free);
54 
55 size_t pdu_read(struct p9_fcall *pdu, void *data, size_t size)
56 {
57 	size_t len = min(pdu->size - pdu->offset, size);
58 	memcpy(data, &pdu->sdata[pdu->offset], len);
59 	pdu->offset += len;
60 	return size - len;
61 }
62 
63 static size_t pdu_write(struct p9_fcall *pdu, const void *data, size_t size)
64 {
65 	size_t len = min(pdu->capacity - pdu->size, size);
66 	memcpy(&pdu->sdata[pdu->size], data, len);
67 	pdu->size += len;
68 	return size - len;
69 }
70 
71 static size_t
72 pdu_write_u(struct p9_fcall *pdu, const char __user *udata, size_t size)
73 {
74 	size_t len = min(pdu->capacity - pdu->size, size);
75 	if (copy_from_user(&pdu->sdata[pdu->size], udata, len))
76 		len = 0;
77 
78 	pdu->size += len;
79 	return size - len;
80 }
81 
82 /*
83 	b - int8_t
84 	w - int16_t
85 	d - int32_t
86 	q - int64_t
87 	s - string
88 	u - numeric uid
89 	g - numeric gid
90 	S - stat
91 	Q - qid
92 	D - data blob (int32_t size followed by void *, results are not freed)
93 	T - array of strings (int16_t count, followed by strings)
94 	R - array of qids (int16_t count, followed by qids)
95 	A - stat for 9p2000.L (p9_stat_dotl)
96 	? - if optional = 1, continue parsing
97 */
98 
99 static int
100 p9pdu_vreadf(struct p9_fcall *pdu, int proto_version, const char *fmt,
101 	va_list ap)
102 {
103 	const char *ptr;
104 	int errcode = 0;
105 
106 	for (ptr = fmt; *ptr; ptr++) {
107 		switch (*ptr) {
108 		case 'b':{
109 				int8_t *val = va_arg(ap, int8_t *);
110 				if (pdu_read(pdu, val, sizeof(*val))) {
111 					errcode = -EFAULT;
112 					break;
113 				}
114 			}
115 			break;
116 		case 'w':{
117 				int16_t *val = va_arg(ap, int16_t *);
118 				__le16 le_val;
119 				if (pdu_read(pdu, &le_val, sizeof(le_val))) {
120 					errcode = -EFAULT;
121 					break;
122 				}
123 				*val = le16_to_cpu(le_val);
124 			}
125 			break;
126 		case 'd':{
127 				int32_t *val = va_arg(ap, int32_t *);
128 				__le32 le_val;
129 				if (pdu_read(pdu, &le_val, sizeof(le_val))) {
130 					errcode = -EFAULT;
131 					break;
132 				}
133 				*val = le32_to_cpu(le_val);
134 			}
135 			break;
136 		case 'q':{
137 				int64_t *val = va_arg(ap, int64_t *);
138 				__le64 le_val;
139 				if (pdu_read(pdu, &le_val, sizeof(le_val))) {
140 					errcode = -EFAULT;
141 					break;
142 				}
143 				*val = le64_to_cpu(le_val);
144 			}
145 			break;
146 		case 's':{
147 				char **sptr = va_arg(ap, char **);
148 				uint16_t len;
149 
150 				errcode = p9pdu_readf(pdu, proto_version,
151 								"w", &len);
152 				if (errcode)
153 					break;
154 
155 				*sptr = kmalloc(len + 1, GFP_NOFS);
156 				if (*sptr == NULL) {
157 					errcode = -EFAULT;
158 					break;
159 				}
160 				if (pdu_read(pdu, *sptr, len)) {
161 					errcode = -EFAULT;
162 					kfree(*sptr);
163 					*sptr = NULL;
164 				} else
165 					(*sptr)[len] = 0;
166 			}
167 			break;
168 		case 'u': {
169 				kuid_t *uid = va_arg(ap, kuid_t *);
170 				__le32 le_val;
171 				if (pdu_read(pdu, &le_val, sizeof(le_val))) {
172 					errcode = -EFAULT;
173 					break;
174 				}
175 				*uid = make_kuid(&init_user_ns,
176 						 le32_to_cpu(le_val));
177 			} break;
178 		case 'g': {
179 				kgid_t *gid = va_arg(ap, kgid_t *);
180 				__le32 le_val;
181 				if (pdu_read(pdu, &le_val, sizeof(le_val))) {
182 					errcode = -EFAULT;
183 					break;
184 				}
185 				*gid = make_kgid(&init_user_ns,
186 						 le32_to_cpu(le_val));
187 			} break;
188 		case 'Q':{
189 				struct p9_qid *qid =
190 				    va_arg(ap, struct p9_qid *);
191 
192 				errcode = p9pdu_readf(pdu, proto_version, "bdq",
193 						      &qid->type, &qid->version,
194 						      &qid->path);
195 			}
196 			break;
197 		case 'S':{
198 				struct p9_wstat *stbuf =
199 				    va_arg(ap, struct p9_wstat *);
200 
201 				memset(stbuf, 0, sizeof(struct p9_wstat));
202 				stbuf->n_uid = stbuf->n_muid = INVALID_UID;
203 				stbuf->n_gid = INVALID_GID;
204 
205 				errcode =
206 				    p9pdu_readf(pdu, proto_version,
207 						"wwdQdddqssss?sugu",
208 						&stbuf->size, &stbuf->type,
209 						&stbuf->dev, &stbuf->qid,
210 						&stbuf->mode, &stbuf->atime,
211 						&stbuf->mtime, &stbuf->length,
212 						&stbuf->name, &stbuf->uid,
213 						&stbuf->gid, &stbuf->muid,
214 						&stbuf->extension,
215 						&stbuf->n_uid, &stbuf->n_gid,
216 						&stbuf->n_muid);
217 				if (errcode)
218 					p9stat_free(stbuf);
219 			}
220 			break;
221 		case 'D':{
222 				uint32_t *count = va_arg(ap, uint32_t *);
223 				void **data = va_arg(ap, void **);
224 
225 				errcode =
226 				    p9pdu_readf(pdu, proto_version, "d", count);
227 				if (!errcode) {
228 					*count =
229 					    min_t(uint32_t, *count,
230 						  pdu->size - pdu->offset);
231 					*data = &pdu->sdata[pdu->offset];
232 				}
233 			}
234 			break;
235 		case 'T':{
236 				uint16_t *nwname = va_arg(ap, uint16_t *);
237 				char ***wnames = va_arg(ap, char ***);
238 
239 				errcode = p9pdu_readf(pdu, proto_version,
240 								"w", nwname);
241 				if (!errcode) {
242 					*wnames =
243 					    kmalloc(sizeof(char *) * *nwname,
244 						    GFP_NOFS);
245 					if (!*wnames)
246 						errcode = -ENOMEM;
247 				}
248 
249 				if (!errcode) {
250 					int i;
251 
252 					for (i = 0; i < *nwname; i++) {
253 						errcode =
254 						    p9pdu_readf(pdu,
255 								proto_version,
256 								"s",
257 								&(*wnames)[i]);
258 						if (errcode)
259 							break;
260 					}
261 				}
262 
263 				if (errcode) {
264 					if (*wnames) {
265 						int i;
266 
267 						for (i = 0; i < *nwname; i++)
268 							kfree((*wnames)[i]);
269 					}
270 					kfree(*wnames);
271 					*wnames = NULL;
272 				}
273 			}
274 			break;
275 		case 'R':{
276 				int16_t *nwqid = va_arg(ap, int16_t *);
277 				struct p9_qid **wqids =
278 				    va_arg(ap, struct p9_qid **);
279 
280 				*wqids = NULL;
281 
282 				errcode =
283 				    p9pdu_readf(pdu, proto_version, "w", nwqid);
284 				if (!errcode) {
285 					*wqids =
286 					    kmalloc(*nwqid *
287 						    sizeof(struct p9_qid),
288 						    GFP_NOFS);
289 					if (*wqids == NULL)
290 						errcode = -ENOMEM;
291 				}
292 
293 				if (!errcode) {
294 					int i;
295 
296 					for (i = 0; i < *nwqid; i++) {
297 						errcode =
298 						    p9pdu_readf(pdu,
299 								proto_version,
300 								"Q",
301 								&(*wqids)[i]);
302 						if (errcode)
303 							break;
304 					}
305 				}
306 
307 				if (errcode) {
308 					kfree(*wqids);
309 					*wqids = NULL;
310 				}
311 			}
312 			break;
313 		case 'A': {
314 				struct p9_stat_dotl *stbuf =
315 				    va_arg(ap, struct p9_stat_dotl *);
316 
317 				memset(stbuf, 0, sizeof(struct p9_stat_dotl));
318 				errcode =
319 				    p9pdu_readf(pdu, proto_version,
320 					"qQdugqqqqqqqqqqqqqqq",
321 					&stbuf->st_result_mask,
322 					&stbuf->qid,
323 					&stbuf->st_mode,
324 					&stbuf->st_uid, &stbuf->st_gid,
325 					&stbuf->st_nlink,
326 					&stbuf->st_rdev, &stbuf->st_size,
327 					&stbuf->st_blksize, &stbuf->st_blocks,
328 					&stbuf->st_atime_sec,
329 					&stbuf->st_atime_nsec,
330 					&stbuf->st_mtime_sec,
331 					&stbuf->st_mtime_nsec,
332 					&stbuf->st_ctime_sec,
333 					&stbuf->st_ctime_nsec,
334 					&stbuf->st_btime_sec,
335 					&stbuf->st_btime_nsec,
336 					&stbuf->st_gen,
337 					&stbuf->st_data_version);
338 			}
339 			break;
340 		case '?':
341 			if ((proto_version != p9_proto_2000u) &&
342 				(proto_version != p9_proto_2000L))
343 				return 0;
344 			break;
345 		default:
346 			BUG();
347 			break;
348 		}
349 
350 		if (errcode)
351 			break;
352 	}
353 
354 	return errcode;
355 }
356 
357 int
358 p9pdu_vwritef(struct p9_fcall *pdu, int proto_version, const char *fmt,
359 	va_list ap)
360 {
361 	const char *ptr;
362 	int errcode = 0;
363 
364 	for (ptr = fmt; *ptr; ptr++) {
365 		switch (*ptr) {
366 		case 'b':{
367 				int8_t val = va_arg(ap, int);
368 				if (pdu_write(pdu, &val, sizeof(val)))
369 					errcode = -EFAULT;
370 			}
371 			break;
372 		case 'w':{
373 				__le16 val = cpu_to_le16(va_arg(ap, int));
374 				if (pdu_write(pdu, &val, sizeof(val)))
375 					errcode = -EFAULT;
376 			}
377 			break;
378 		case 'd':{
379 				__le32 val = cpu_to_le32(va_arg(ap, int32_t));
380 				if (pdu_write(pdu, &val, sizeof(val)))
381 					errcode = -EFAULT;
382 			}
383 			break;
384 		case 'q':{
385 				__le64 val = cpu_to_le64(va_arg(ap, int64_t));
386 				if (pdu_write(pdu, &val, sizeof(val)))
387 					errcode = -EFAULT;
388 			}
389 			break;
390 		case 's':{
391 				const char *sptr = va_arg(ap, const char *);
392 				uint16_t len = 0;
393 				if (sptr)
394 					len = min_t(size_t, strlen(sptr),
395 								USHRT_MAX);
396 
397 				errcode = p9pdu_writef(pdu, proto_version,
398 								"w", len);
399 				if (!errcode && pdu_write(pdu, sptr, len))
400 					errcode = -EFAULT;
401 			}
402 			break;
403 		case 'u': {
404 				kuid_t uid = va_arg(ap, kuid_t);
405 				__le32 val = cpu_to_le32(
406 						from_kuid(&init_user_ns, uid));
407 				if (pdu_write(pdu, &val, sizeof(val)))
408 					errcode = -EFAULT;
409 			} break;
410 		case 'g': {
411 				kgid_t gid = va_arg(ap, kgid_t);
412 				__le32 val = cpu_to_le32(
413 						from_kgid(&init_user_ns, gid));
414 				if (pdu_write(pdu, &val, sizeof(val)))
415 					errcode = -EFAULT;
416 			} break;
417 		case 'Q':{
418 				const struct p9_qid *qid =
419 				    va_arg(ap, const struct p9_qid *);
420 				errcode =
421 				    p9pdu_writef(pdu, proto_version, "bdq",
422 						 qid->type, qid->version,
423 						 qid->path);
424 			} break;
425 		case 'S':{
426 				const struct p9_wstat *stbuf =
427 				    va_arg(ap, const struct p9_wstat *);
428 				errcode =
429 				    p9pdu_writef(pdu, proto_version,
430 						 "wwdQdddqssss?sugu",
431 						 stbuf->size, stbuf->type,
432 						 stbuf->dev, &stbuf->qid,
433 						 stbuf->mode, stbuf->atime,
434 						 stbuf->mtime, stbuf->length,
435 						 stbuf->name, stbuf->uid,
436 						 stbuf->gid, stbuf->muid,
437 						 stbuf->extension, stbuf->n_uid,
438 						 stbuf->n_gid, stbuf->n_muid);
439 			} break;
440 		case 'D':{
441 				uint32_t count = va_arg(ap, uint32_t);
442 				const void *data = va_arg(ap, const void *);
443 
444 				errcode = p9pdu_writef(pdu, proto_version, "d",
445 									count);
446 				if (!errcode && pdu_write(pdu, data, count))
447 					errcode = -EFAULT;
448 			}
449 			break;
450 		case 'U':{
451 				int32_t count = va_arg(ap, int32_t);
452 				const char __user *udata =
453 						va_arg(ap, const void __user *);
454 				errcode = p9pdu_writef(pdu, proto_version, "d",
455 									count);
456 				if (!errcode && pdu_write_u(pdu, udata, count))
457 					errcode = -EFAULT;
458 			}
459 			break;
460 		case 'T':{
461 				uint16_t nwname = va_arg(ap, int);
462 				const char **wnames = va_arg(ap, const char **);
463 
464 				errcode = p9pdu_writef(pdu, proto_version, "w",
465 									nwname);
466 				if (!errcode) {
467 					int i;
468 
469 					for (i = 0; i < nwname; i++) {
470 						errcode =
471 						    p9pdu_writef(pdu,
472 								proto_version,
473 								 "s",
474 								 wnames[i]);
475 						if (errcode)
476 							break;
477 					}
478 				}
479 			}
480 			break;
481 		case 'R':{
482 				int16_t nwqid = va_arg(ap, int);
483 				struct p9_qid *wqids =
484 				    va_arg(ap, struct p9_qid *);
485 
486 				errcode = p9pdu_writef(pdu, proto_version, "w",
487 									nwqid);
488 				if (!errcode) {
489 					int i;
490 
491 					for (i = 0; i < nwqid; i++) {
492 						errcode =
493 						    p9pdu_writef(pdu,
494 								proto_version,
495 								 "Q",
496 								 &wqids[i]);
497 						if (errcode)
498 							break;
499 					}
500 				}
501 			}
502 			break;
503 		case 'I':{
504 				struct p9_iattr_dotl *p9attr = va_arg(ap,
505 							struct p9_iattr_dotl *);
506 
507 				errcode = p9pdu_writef(pdu, proto_version,
508 							"ddugqqqqq",
509 							p9attr->valid,
510 							p9attr->mode,
511 							p9attr->uid,
512 							p9attr->gid,
513 							p9attr->size,
514 							p9attr->atime_sec,
515 							p9attr->atime_nsec,
516 							p9attr->mtime_sec,
517 							p9attr->mtime_nsec);
518 			}
519 			break;
520 		case '?':
521 			if ((proto_version != p9_proto_2000u) &&
522 				(proto_version != p9_proto_2000L))
523 				return 0;
524 			break;
525 		default:
526 			BUG();
527 			break;
528 		}
529 
530 		if (errcode)
531 			break;
532 	}
533 
534 	return errcode;
535 }
536 
537 int p9pdu_readf(struct p9_fcall *pdu, int proto_version, const char *fmt, ...)
538 {
539 	va_list ap;
540 	int ret;
541 
542 	va_start(ap, fmt);
543 	ret = p9pdu_vreadf(pdu, proto_version, fmt, ap);
544 	va_end(ap);
545 
546 	return ret;
547 }
548 
549 static int
550 p9pdu_writef(struct p9_fcall *pdu, int proto_version, const char *fmt, ...)
551 {
552 	va_list ap;
553 	int ret;
554 
555 	va_start(ap, fmt);
556 	ret = p9pdu_vwritef(pdu, proto_version, fmt, ap);
557 	va_end(ap);
558 
559 	return ret;
560 }
561 
562 int p9stat_read(struct p9_client *clnt, char *buf, int len, struct p9_wstat *st)
563 {
564 	struct p9_fcall fake_pdu;
565 	int ret;
566 
567 	fake_pdu.size = len;
568 	fake_pdu.capacity = len;
569 	fake_pdu.sdata = buf;
570 	fake_pdu.offset = 0;
571 
572 	ret = p9pdu_readf(&fake_pdu, clnt->proto_version, "S", st);
573 	if (ret) {
574 		p9_debug(P9_DEBUG_9P, "<<< p9stat_read failed: %d\n", ret);
575 		trace_9p_protocol_dump(clnt, &fake_pdu);
576 	}
577 
578 	return ret;
579 }
580 EXPORT_SYMBOL(p9stat_read);
581 
582 int p9pdu_prepare(struct p9_fcall *pdu, int16_t tag, int8_t type)
583 {
584 	pdu->id = type;
585 	return p9pdu_writef(pdu, 0, "dbw", 0, type, tag);
586 }
587 
588 int p9pdu_finalize(struct p9_client *clnt, struct p9_fcall *pdu)
589 {
590 	int size = pdu->size;
591 	int err;
592 
593 	pdu->size = 0;
594 	err = p9pdu_writef(pdu, 0, "d", size);
595 	pdu->size = size;
596 
597 	trace_9p_protocol_dump(clnt, pdu);
598 	p9_debug(P9_DEBUG_9P, ">>> size=%d type: %d tag: %d\n",
599 		 pdu->size, pdu->id, pdu->tag);
600 
601 	return err;
602 }
603 
604 void p9pdu_reset(struct p9_fcall *pdu)
605 {
606 	pdu->offset = 0;
607 	pdu->size = 0;
608 }
609 
610 int p9dirent_read(struct p9_client *clnt, char *buf, int len,
611 		  struct p9_dirent *dirent)
612 {
613 	struct p9_fcall fake_pdu;
614 	int ret;
615 	char *nameptr;
616 
617 	fake_pdu.size = len;
618 	fake_pdu.capacity = len;
619 	fake_pdu.sdata = buf;
620 	fake_pdu.offset = 0;
621 
622 	ret = p9pdu_readf(&fake_pdu, clnt->proto_version, "Qqbs", &dirent->qid,
623 			  &dirent->d_off, &dirent->d_type, &nameptr);
624 	if (ret) {
625 		p9_debug(P9_DEBUG_9P, "<<< p9dirent_read failed: %d\n", ret);
626 		trace_9p_protocol_dump(clnt, &fake_pdu);
627 		goto out;
628 	}
629 
630 	strcpy(dirent->d_name, nameptr);
631 	kfree(nameptr);
632 
633 out:
634 	return fake_pdu.offset;
635 }
636 EXPORT_SYMBOL(p9dirent_read);
637