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