Linux Audio

Check our new training course

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