]> git.proxmox.com Git - mirror_qemu.git/blob - hw/9pfs/virtio-9p.c
hw/9pfs: Update v9fs_xattrcreate to use coroutines
[mirror_qemu.git] / hw / 9pfs / virtio-9p.c
1 /*
2 * Virtio 9p backend
3 *
4 * Copyright IBM, Corp. 2010
5 *
6 * Authors:
7 * Anthony Liguori <aliguori@us.ibm.com>
8 *
9 * This work is licensed under the terms of the GNU GPL, version 2. See
10 * the COPYING file in the top-level directory.
11 *
12 */
13
14 #include "hw/virtio.h"
15 #include "hw/pc.h"
16 #include "qemu_socket.h"
17 #include "hw/virtio-pci.h"
18 #include "virtio-9p.h"
19 #include "fsdev/qemu-fsdev.h"
20 #include "virtio-9p-debug.h"
21 #include "virtio-9p-xattr.h"
22 #include "virtio-9p-coth.h"
23
24 int debug_9p_pdu;
25
26 enum {
27 Oread = 0x00,
28 Owrite = 0x01,
29 Ordwr = 0x02,
30 Oexec = 0x03,
31 Oexcl = 0x04,
32 Otrunc = 0x10,
33 Orexec = 0x20,
34 Orclose = 0x40,
35 Oappend = 0x80,
36 };
37
38 static int omode_to_uflags(int8_t mode)
39 {
40 int ret = 0;
41
42 switch (mode & 3) {
43 case Oread:
44 ret = O_RDONLY;
45 break;
46 case Ordwr:
47 ret = O_RDWR;
48 break;
49 case Owrite:
50 ret = O_WRONLY;
51 break;
52 case Oexec:
53 ret = O_RDONLY;
54 break;
55 }
56
57 if (mode & Otrunc) {
58 ret |= O_TRUNC;
59 }
60
61 if (mode & Oappend) {
62 ret |= O_APPEND;
63 }
64
65 if (mode & Oexcl) {
66 ret |= O_EXCL;
67 }
68
69 return ret;
70 }
71
72 void cred_init(FsCred *credp)
73 {
74 credp->fc_uid = -1;
75 credp->fc_gid = -1;
76 credp->fc_mode = -1;
77 credp->fc_rdev = -1;
78 }
79
80 static int v9fs_do_lstat(V9fsState *s, V9fsString *path, struct stat *stbuf)
81 {
82 return s->ops->lstat(&s->ctx, path->data, stbuf);
83 }
84
85 static int v9fs_do_close(V9fsState *s, int fd)
86 {
87 return s->ops->close(&s->ctx, fd);
88 }
89
90 static int v9fs_do_closedir(V9fsState *s, DIR *dir)
91 {
92 return s->ops->closedir(&s->ctx, dir);
93 }
94
95 static int v9fs_do_open(V9fsState *s, V9fsString *path, int flags)
96 {
97 return s->ops->open(&s->ctx, path->data, flags);
98 }
99
100 static DIR *v9fs_do_opendir(V9fsState *s, V9fsString *path)
101 {
102 return s->ops->opendir(&s->ctx, path->data);
103 }
104
105 static void v9fs_do_rewinddir(V9fsState *s, DIR *dir)
106 {
107 return s->ops->rewinddir(&s->ctx, dir);
108 }
109
110 static off_t v9fs_do_telldir(V9fsState *s, DIR *dir)
111 {
112 return s->ops->telldir(&s->ctx, dir);
113 }
114
115 static void v9fs_do_seekdir(V9fsState *s, DIR *dir, off_t off)
116 {
117 return s->ops->seekdir(&s->ctx, dir, off);
118 }
119
120 static int v9fs_do_preadv(V9fsState *s, int fd, const struct iovec *iov,
121 int iovcnt, int64_t offset)
122 {
123 return s->ops->preadv(&s->ctx, fd, iov, iovcnt, offset);
124 }
125
126 static int v9fs_do_pwritev(V9fsState *s, int fd, const struct iovec *iov,
127 int iovcnt, int64_t offset)
128 {
129 return s->ops->pwritev(&s->ctx, fd, iov, iovcnt, offset);
130 }
131
132 static int v9fs_do_chmod(V9fsState *s, V9fsString *path, mode_t mode)
133 {
134 FsCred cred;
135 cred_init(&cred);
136 cred.fc_mode = mode;
137 return s->ops->chmod(&s->ctx, path->data, &cred);
138 }
139
140 static int v9fs_do_mknod(V9fsState *s, char *name,
141 mode_t mode, dev_t dev, uid_t uid, gid_t gid)
142 {
143 FsCred cred;
144 cred_init(&cred);
145 cred.fc_uid = uid;
146 cred.fc_gid = gid;
147 cred.fc_mode = mode;
148 cred.fc_rdev = dev;
149 return s->ops->mknod(&s->ctx, name, &cred);
150 }
151
152 static int v9fs_do_mkdir(V9fsState *s, char *name, mode_t mode,
153 uid_t uid, gid_t gid)
154 {
155 FsCred cred;
156
157 cred_init(&cred);
158 cred.fc_uid = uid;
159 cred.fc_gid = gid;
160 cred.fc_mode = mode;
161
162 return s->ops->mkdir(&s->ctx, name, &cred);
163 }
164
165 static int v9fs_do_fstat(V9fsState *s, int fd, struct stat *stbuf)
166 {
167 return s->ops->fstat(&s->ctx, fd, stbuf);
168 }
169
170 static int v9fs_do_open2(V9fsState *s, char *fullname, uid_t uid, gid_t gid,
171 int flags, int mode)
172 {
173 FsCred cred;
174
175 cred_init(&cred);
176 cred.fc_uid = uid;
177 cred.fc_gid = gid;
178 cred.fc_mode = mode & 07777;
179
180 return s->ops->open2(&s->ctx, fullname, flags, &cred);
181 }
182
183 static int v9fs_do_symlink(V9fsState *s, V9fsFidState *fidp,
184 const char *oldpath, const char *newpath, gid_t gid)
185 {
186 FsCred cred;
187 cred_init(&cred);
188 cred.fc_uid = fidp->uid;
189 cred.fc_gid = gid;
190 cred.fc_mode = 0777;
191
192 return s->ops->symlink(&s->ctx, oldpath, newpath, &cred);
193 }
194
195 static int v9fs_do_link(V9fsState *s, V9fsString *oldpath, V9fsString *newpath)
196 {
197 return s->ops->link(&s->ctx, oldpath->data, newpath->data);
198 }
199
200 static int v9fs_do_truncate(V9fsState *s, V9fsString *path, off_t size)
201 {
202 return s->ops->truncate(&s->ctx, path->data, size);
203 }
204
205 static int v9fs_do_rename(V9fsState *s, V9fsString *oldpath,
206 V9fsString *newpath)
207 {
208 return s->ops->rename(&s->ctx, oldpath->data, newpath->data);
209 }
210
211 static int v9fs_do_chown(V9fsState *s, V9fsString *path, uid_t uid, gid_t gid)
212 {
213 FsCred cred;
214 cred_init(&cred);
215 cred.fc_uid = uid;
216 cred.fc_gid = gid;
217
218 return s->ops->chown(&s->ctx, path->data, &cred);
219 }
220
221 static int v9fs_do_utimensat(V9fsState *s, V9fsString *path,
222 const struct timespec times[2])
223 {
224 return s->ops->utimensat(&s->ctx, path->data, times);
225 }
226
227 static int v9fs_do_remove(V9fsState *s, V9fsString *path)
228 {
229 return s->ops->remove(&s->ctx, path->data);
230 }
231
232 static int v9fs_do_fsync(V9fsState *s, int fd, int datasync)
233 {
234 return s->ops->fsync(&s->ctx, fd, datasync);
235 }
236
237 static int v9fs_do_statfs(V9fsState *s, V9fsString *path, struct statfs *stbuf)
238 {
239 return s->ops->statfs(&s->ctx, path->data, stbuf);
240 }
241
242 static int v9fs_do_lsetxattr(V9fsState *s, V9fsString *path,
243 V9fsString *xattr_name,
244 void *value, size_t size, int flags)
245 {
246 return s->ops->lsetxattr(&s->ctx, path->data,
247 xattr_name->data, value, size, flags);
248 }
249
250 static int v9fs_do_lremovexattr(V9fsState *s, V9fsString *path,
251 V9fsString *xattr_name)
252 {
253 return s->ops->lremovexattr(&s->ctx, path->data,
254 xattr_name->data);
255 }
256
257
258 static void v9fs_string_init(V9fsString *str)
259 {
260 str->data = NULL;
261 str->size = 0;
262 }
263
264 static void v9fs_string_free(V9fsString *str)
265 {
266 qemu_free(str->data);
267 str->data = NULL;
268 str->size = 0;
269 }
270
271 static void v9fs_string_null(V9fsString *str)
272 {
273 v9fs_string_free(str);
274 }
275
276 static int number_to_string(void *arg, char type)
277 {
278 unsigned int ret = 0;
279
280 switch (type) {
281 case 'u': {
282 unsigned int num = *(unsigned int *)arg;
283
284 do {
285 ret++;
286 num = num/10;
287 } while (num);
288 break;
289 }
290 case 'U': {
291 unsigned long num = *(unsigned long *)arg;
292 do {
293 ret++;
294 num = num/10;
295 } while (num);
296 break;
297 }
298 default:
299 printf("Number_to_string: Unknown number format\n");
300 return -1;
301 }
302
303 return ret;
304 }
305
306 static int GCC_FMT_ATTR(2, 0)
307 v9fs_string_alloc_printf(char **strp, const char *fmt, va_list ap)
308 {
309 va_list ap2;
310 char *iter = (char *)fmt;
311 int len = 0;
312 int nr_args = 0;
313 char *arg_char_ptr;
314 unsigned int arg_uint;
315 unsigned long arg_ulong;
316
317 /* Find the number of %'s that denotes an argument */
318 for (iter = strstr(iter, "%"); iter; iter = strstr(iter, "%")) {
319 nr_args++;
320 iter++;
321 }
322
323 len = strlen(fmt) - 2*nr_args;
324
325 if (!nr_args) {
326 goto alloc_print;
327 }
328
329 va_copy(ap2, ap);
330
331 iter = (char *)fmt;
332
333 /* Now parse the format string */
334 for (iter = strstr(iter, "%"); iter; iter = strstr(iter, "%")) {
335 iter++;
336 switch (*iter) {
337 case 'u':
338 arg_uint = va_arg(ap2, unsigned int);
339 len += number_to_string((void *)&arg_uint, 'u');
340 break;
341 case 'l':
342 if (*++iter == 'u') {
343 arg_ulong = va_arg(ap2, unsigned long);
344 len += number_to_string((void *)&arg_ulong, 'U');
345 } else {
346 return -1;
347 }
348 break;
349 case 's':
350 arg_char_ptr = va_arg(ap2, char *);
351 len += strlen(arg_char_ptr);
352 break;
353 case 'c':
354 len += 1;
355 break;
356 default:
357 fprintf(stderr,
358 "v9fs_string_alloc_printf:Incorrect format %c", *iter);
359 return -1;
360 }
361 iter++;
362 }
363
364 alloc_print:
365 *strp = qemu_malloc((len + 1) * sizeof(**strp));
366
367 return vsprintf(*strp, fmt, ap);
368 }
369
370 static void GCC_FMT_ATTR(2, 3)
371 v9fs_string_sprintf(V9fsString *str, const char *fmt, ...)
372 {
373 va_list ap;
374 int err;
375
376 v9fs_string_free(str);
377
378 va_start(ap, fmt);
379 err = v9fs_string_alloc_printf(&str->data, fmt, ap);
380 BUG_ON(err == -1);
381 va_end(ap);
382
383 str->size = err;
384 }
385
386 static void v9fs_string_copy(V9fsString *lhs, V9fsString *rhs)
387 {
388 v9fs_string_free(lhs);
389 v9fs_string_sprintf(lhs, "%s", rhs->data);
390 }
391
392 /*
393 * Return TRUE if s1 is an ancestor of s2.
394 *
395 * E.g. "a/b" is an ancestor of "a/b/c" but not of "a/bc/d".
396 * As a special case, We treat s1 as ancestor of s2 if they are same!
397 */
398 static int v9fs_path_is_ancestor(V9fsString *s1, V9fsString *s2)
399 {
400 if (!strncmp(s1->data, s2->data, s1->size)) {
401 if (s2->data[s1->size] == '\0' || s2->data[s1->size] == '/') {
402 return 1;
403 }
404 }
405 return 0;
406 }
407
408 static size_t v9fs_string_size(V9fsString *str)
409 {
410 return str->size;
411 }
412
413 static V9fsFidState *lookup_fid(V9fsState *s, int32_t fid)
414 {
415 V9fsFidState *f;
416
417 for (f = s->fid_list; f; f = f->next) {
418 if (f->fid == fid) {
419 return f;
420 }
421 }
422
423 return NULL;
424 }
425
426 static V9fsFidState *alloc_fid(V9fsState *s, int32_t fid)
427 {
428 V9fsFidState *f;
429
430 f = lookup_fid(s, fid);
431 if (f) {
432 return NULL;
433 }
434
435 f = qemu_mallocz(sizeof(V9fsFidState));
436
437 f->fid = fid;
438 f->fid_type = P9_FID_NONE;
439
440 f->next = s->fid_list;
441 s->fid_list = f;
442
443 return f;
444 }
445
446 static int v9fs_xattr_fid_clunk(V9fsState *s, V9fsFidState *fidp)
447 {
448 int retval = 0;
449
450 if (fidp->fs.xattr.copied_len == -1) {
451 /* getxattr/listxattr fid */
452 goto free_value;
453 }
454 /*
455 * if this is fid for setxattr. clunk should
456 * result in setxattr localcall
457 */
458 if (fidp->fs.xattr.len != fidp->fs.xattr.copied_len) {
459 /* clunk after partial write */
460 retval = -EINVAL;
461 goto free_out;
462 }
463 if (fidp->fs.xattr.len) {
464 retval = v9fs_do_lsetxattr(s, &fidp->path, &fidp->fs.xattr.name,
465 fidp->fs.xattr.value,
466 fidp->fs.xattr.len,
467 fidp->fs.xattr.flags);
468 } else {
469 retval = v9fs_do_lremovexattr(s, &fidp->path, &fidp->fs.xattr.name);
470 }
471 free_out:
472 v9fs_string_free(&fidp->fs.xattr.name);
473 free_value:
474 if (fidp->fs.xattr.value) {
475 qemu_free(fidp->fs.xattr.value);
476 }
477 return retval;
478 }
479
480 static int free_fid(V9fsState *s, int32_t fid)
481 {
482 int retval = 0;
483 V9fsFidState **fidpp, *fidp;
484
485 for (fidpp = &s->fid_list; *fidpp; fidpp = &(*fidpp)->next) {
486 if ((*fidpp)->fid == fid) {
487 break;
488 }
489 }
490
491 if (*fidpp == NULL) {
492 return -ENOENT;
493 }
494
495 fidp = *fidpp;
496 *fidpp = fidp->next;
497
498 if (fidp->fid_type == P9_FID_FILE) {
499 v9fs_do_close(s, fidp->fs.fd);
500 } else if (fidp->fid_type == P9_FID_DIR) {
501 v9fs_do_closedir(s, fidp->fs.dir);
502 } else if (fidp->fid_type == P9_FID_XATTR) {
503 retval = v9fs_xattr_fid_clunk(s, fidp);
504 }
505 v9fs_string_free(&fidp->path);
506 qemu_free(fidp);
507
508 return retval;
509 }
510
511 #define P9_QID_TYPE_DIR 0x80
512 #define P9_QID_TYPE_SYMLINK 0x02
513
514 #define P9_STAT_MODE_DIR 0x80000000
515 #define P9_STAT_MODE_APPEND 0x40000000
516 #define P9_STAT_MODE_EXCL 0x20000000
517 #define P9_STAT_MODE_MOUNT 0x10000000
518 #define P9_STAT_MODE_AUTH 0x08000000
519 #define P9_STAT_MODE_TMP 0x04000000
520 #define P9_STAT_MODE_SYMLINK 0x02000000
521 #define P9_STAT_MODE_LINK 0x01000000
522 #define P9_STAT_MODE_DEVICE 0x00800000
523 #define P9_STAT_MODE_NAMED_PIPE 0x00200000
524 #define P9_STAT_MODE_SOCKET 0x00100000
525 #define P9_STAT_MODE_SETUID 0x00080000
526 #define P9_STAT_MODE_SETGID 0x00040000
527 #define P9_STAT_MODE_SETVTX 0x00010000
528
529 #define P9_STAT_MODE_TYPE_BITS (P9_STAT_MODE_DIR | \
530 P9_STAT_MODE_SYMLINK | \
531 P9_STAT_MODE_LINK | \
532 P9_STAT_MODE_DEVICE | \
533 P9_STAT_MODE_NAMED_PIPE | \
534 P9_STAT_MODE_SOCKET)
535
536 /* This is the algorithm from ufs in spfs */
537 static void stat_to_qid(const struct stat *stbuf, V9fsQID *qidp)
538 {
539 size_t size;
540
541 size = MIN(sizeof(stbuf->st_ino), sizeof(qidp->path));
542 memcpy(&qidp->path, &stbuf->st_ino, size);
543 qidp->version = stbuf->st_mtime ^ (stbuf->st_size << 8);
544 qidp->type = 0;
545 if (S_ISDIR(stbuf->st_mode)) {
546 qidp->type |= P9_QID_TYPE_DIR;
547 }
548 if (S_ISLNK(stbuf->st_mode)) {
549 qidp->type |= P9_QID_TYPE_SYMLINK;
550 }
551 }
552
553 static int fid_to_qid(V9fsState *s, V9fsFidState *fidp, V9fsQID *qidp)
554 {
555 struct stat stbuf;
556 int err;
557
558 err = v9fs_do_lstat(s, &fidp->path, &stbuf);
559 if (err) {
560 return err;
561 }
562
563 stat_to_qid(&stbuf, qidp);
564 return 0;
565 }
566
567 static V9fsPDU *alloc_pdu(V9fsState *s)
568 {
569 V9fsPDU *pdu = NULL;
570
571 if (!QLIST_EMPTY(&s->free_list)) {
572 pdu = QLIST_FIRST(&s->free_list);
573 QLIST_REMOVE(pdu, next);
574 }
575 return pdu;
576 }
577
578 static void free_pdu(V9fsState *s, V9fsPDU *pdu)
579 {
580 if (pdu) {
581 if (debug_9p_pdu) {
582 pprint_pdu(pdu);
583 }
584 QLIST_INSERT_HEAD(&s->free_list, pdu, next);
585 }
586 }
587
588 size_t pdu_packunpack(void *addr, struct iovec *sg, int sg_count,
589 size_t offset, size_t size, int pack)
590 {
591 int i = 0;
592 size_t copied = 0;
593
594 for (i = 0; size && i < sg_count; i++) {
595 size_t len;
596 if (offset >= sg[i].iov_len) {
597 /* skip this sg */
598 offset -= sg[i].iov_len;
599 continue;
600 } else {
601 len = MIN(sg[i].iov_len - offset, size);
602 if (pack) {
603 memcpy(sg[i].iov_base + offset, addr, len);
604 } else {
605 memcpy(addr, sg[i].iov_base + offset, len);
606 }
607 size -= len;
608 copied += len;
609 addr += len;
610 if (size) {
611 offset = 0;
612 continue;
613 }
614 }
615 }
616
617 return copied;
618 }
619
620 static size_t pdu_unpack(void *dst, V9fsPDU *pdu, size_t offset, size_t size)
621 {
622 return pdu_packunpack(dst, pdu->elem.out_sg, pdu->elem.out_num,
623 offset, size, 0);
624 }
625
626 static size_t pdu_pack(V9fsPDU *pdu, size_t offset, const void *src,
627 size_t size)
628 {
629 return pdu_packunpack((void *)src, pdu->elem.in_sg, pdu->elem.in_num,
630 offset, size, 1);
631 }
632
633 static int pdu_copy_sg(V9fsPDU *pdu, size_t offset, int rx, struct iovec *sg)
634 {
635 size_t pos = 0;
636 int i, j;
637 struct iovec *src_sg;
638 unsigned int num;
639
640 if (rx) {
641 src_sg = pdu->elem.in_sg;
642 num = pdu->elem.in_num;
643 } else {
644 src_sg = pdu->elem.out_sg;
645 num = pdu->elem.out_num;
646 }
647
648 j = 0;
649 for (i = 0; i < num; i++) {
650 if (offset <= pos) {
651 sg[j].iov_base = src_sg[i].iov_base;
652 sg[j].iov_len = src_sg[i].iov_len;
653 j++;
654 } else if (offset < (src_sg[i].iov_len + pos)) {
655 sg[j].iov_base = src_sg[i].iov_base;
656 sg[j].iov_len = src_sg[i].iov_len;
657 sg[j].iov_base += (offset - pos);
658 sg[j].iov_len -= (offset - pos);
659 j++;
660 }
661 pos += src_sg[i].iov_len;
662 }
663
664 return j;
665 }
666
667 static size_t pdu_unmarshal(V9fsPDU *pdu, size_t offset, const char *fmt, ...)
668 {
669 size_t old_offset = offset;
670 va_list ap;
671 int i;
672
673 va_start(ap, fmt);
674 for (i = 0; fmt[i]; i++) {
675 switch (fmt[i]) {
676 case 'b': {
677 uint8_t *valp = va_arg(ap, uint8_t *);
678 offset += pdu_unpack(valp, pdu, offset, sizeof(*valp));
679 break;
680 }
681 case 'w': {
682 uint16_t val, *valp;
683 valp = va_arg(ap, uint16_t *);
684 offset += pdu_unpack(&val, pdu, offset, sizeof(val));
685 *valp = le16_to_cpu(val);
686 break;
687 }
688 case 'd': {
689 uint32_t val, *valp;
690 valp = va_arg(ap, uint32_t *);
691 offset += pdu_unpack(&val, pdu, offset, sizeof(val));
692 *valp = le32_to_cpu(val);
693 break;
694 }
695 case 'q': {
696 uint64_t val, *valp;
697 valp = va_arg(ap, uint64_t *);
698 offset += pdu_unpack(&val, pdu, offset, sizeof(val));
699 *valp = le64_to_cpu(val);
700 break;
701 }
702 case 'v': {
703 struct iovec *iov = va_arg(ap, struct iovec *);
704 int *iovcnt = va_arg(ap, int *);
705 *iovcnt = pdu_copy_sg(pdu, offset, 0, iov);
706 break;
707 }
708 case 's': {
709 V9fsString *str = va_arg(ap, V9fsString *);
710 offset += pdu_unmarshal(pdu, offset, "w", &str->size);
711 /* FIXME: sanity check str->size */
712 str->data = qemu_malloc(str->size + 1);
713 offset += pdu_unpack(str->data, pdu, offset, str->size);
714 str->data[str->size] = 0;
715 break;
716 }
717 case 'Q': {
718 V9fsQID *qidp = va_arg(ap, V9fsQID *);
719 offset += pdu_unmarshal(pdu, offset, "bdq",
720 &qidp->type, &qidp->version, &qidp->path);
721 break;
722 }
723 case 'S': {
724 V9fsStat *statp = va_arg(ap, V9fsStat *);
725 offset += pdu_unmarshal(pdu, offset, "wwdQdddqsssssddd",
726 &statp->size, &statp->type, &statp->dev,
727 &statp->qid, &statp->mode, &statp->atime,
728 &statp->mtime, &statp->length,
729 &statp->name, &statp->uid, &statp->gid,
730 &statp->muid, &statp->extension,
731 &statp->n_uid, &statp->n_gid,
732 &statp->n_muid);
733 break;
734 }
735 case 'I': {
736 V9fsIattr *iattr = va_arg(ap, V9fsIattr *);
737 offset += pdu_unmarshal(pdu, offset, "ddddqqqqq",
738 &iattr->valid, &iattr->mode,
739 &iattr->uid, &iattr->gid, &iattr->size,
740 &iattr->atime_sec, &iattr->atime_nsec,
741 &iattr->mtime_sec, &iattr->mtime_nsec);
742 break;
743 }
744 default:
745 break;
746 }
747 }
748
749 va_end(ap);
750
751 return offset - old_offset;
752 }
753
754 static size_t pdu_marshal(V9fsPDU *pdu, size_t offset, const char *fmt, ...)
755 {
756 size_t old_offset = offset;
757 va_list ap;
758 int i;
759
760 va_start(ap, fmt);
761 for (i = 0; fmt[i]; i++) {
762 switch (fmt[i]) {
763 case 'b': {
764 uint8_t val = va_arg(ap, int);
765 offset += pdu_pack(pdu, offset, &val, sizeof(val));
766 break;
767 }
768 case 'w': {
769 uint16_t val;
770 cpu_to_le16w(&val, va_arg(ap, int));
771 offset += pdu_pack(pdu, offset, &val, sizeof(val));
772 break;
773 }
774 case 'd': {
775 uint32_t val;
776 cpu_to_le32w(&val, va_arg(ap, uint32_t));
777 offset += pdu_pack(pdu, offset, &val, sizeof(val));
778 break;
779 }
780 case 'q': {
781 uint64_t val;
782 cpu_to_le64w(&val, va_arg(ap, uint64_t));
783 offset += pdu_pack(pdu, offset, &val, sizeof(val));
784 break;
785 }
786 case 'v': {
787 struct iovec *iov = va_arg(ap, struct iovec *);
788 int *iovcnt = va_arg(ap, int *);
789 *iovcnt = pdu_copy_sg(pdu, offset, 1, iov);
790 break;
791 }
792 case 's': {
793 V9fsString *str = va_arg(ap, V9fsString *);
794 offset += pdu_marshal(pdu, offset, "w", str->size);
795 offset += pdu_pack(pdu, offset, str->data, str->size);
796 break;
797 }
798 case 'Q': {
799 V9fsQID *qidp = va_arg(ap, V9fsQID *);
800 offset += pdu_marshal(pdu, offset, "bdq",
801 qidp->type, qidp->version, qidp->path);
802 break;
803 }
804 case 'S': {
805 V9fsStat *statp = va_arg(ap, V9fsStat *);
806 offset += pdu_marshal(pdu, offset, "wwdQdddqsssssddd",
807 statp->size, statp->type, statp->dev,
808 &statp->qid, statp->mode, statp->atime,
809 statp->mtime, statp->length, &statp->name,
810 &statp->uid, &statp->gid, &statp->muid,
811 &statp->extension, statp->n_uid,
812 statp->n_gid, statp->n_muid);
813 break;
814 }
815 case 'A': {
816 V9fsStatDotl *statp = va_arg(ap, V9fsStatDotl *);
817 offset += pdu_marshal(pdu, offset, "qQdddqqqqqqqqqqqqqqq",
818 statp->st_result_mask,
819 &statp->qid, statp->st_mode,
820 statp->st_uid, statp->st_gid,
821 statp->st_nlink, statp->st_rdev,
822 statp->st_size, statp->st_blksize, statp->st_blocks,
823 statp->st_atime_sec, statp->st_atime_nsec,
824 statp->st_mtime_sec, statp->st_mtime_nsec,
825 statp->st_ctime_sec, statp->st_ctime_nsec,
826 statp->st_btime_sec, statp->st_btime_nsec,
827 statp->st_gen, statp->st_data_version);
828 break;
829 }
830 default:
831 break;
832 }
833 }
834 va_end(ap);
835
836 return offset - old_offset;
837 }
838
839 static void complete_pdu(V9fsState *s, V9fsPDU *pdu, ssize_t len)
840 {
841 int8_t id = pdu->id + 1; /* Response */
842
843 if (len < 0) {
844 int err = -len;
845 len = 7;
846
847 if (s->proto_version != V9FS_PROTO_2000L) {
848 V9fsString str;
849
850 str.data = strerror(err);
851 str.size = strlen(str.data);
852
853 len += pdu_marshal(pdu, len, "s", &str);
854 id = P9_RERROR;
855 }
856
857 len += pdu_marshal(pdu, len, "d", err);
858
859 if (s->proto_version == V9FS_PROTO_2000L) {
860 id = P9_RLERROR;
861 }
862 }
863
864 /* fill out the header */
865 pdu_marshal(pdu, 0, "dbw", (int32_t)len, id, pdu->tag);
866
867 /* keep these in sync */
868 pdu->size = len;
869 pdu->id = id;
870
871 /* push onto queue and notify */
872 virtqueue_push(s->vq, &pdu->elem, len);
873
874 /* FIXME: we should batch these completions */
875 virtio_notify(&s->vdev, s->vq);
876
877 free_pdu(s, pdu);
878 }
879
880 static mode_t v9mode_to_mode(uint32_t mode, V9fsString *extension)
881 {
882 mode_t ret;
883
884 ret = mode & 0777;
885 if (mode & P9_STAT_MODE_DIR) {
886 ret |= S_IFDIR;
887 }
888
889 if (mode & P9_STAT_MODE_SYMLINK) {
890 ret |= S_IFLNK;
891 }
892 if (mode & P9_STAT_MODE_SOCKET) {
893 ret |= S_IFSOCK;
894 }
895 if (mode & P9_STAT_MODE_NAMED_PIPE) {
896 ret |= S_IFIFO;
897 }
898 if (mode & P9_STAT_MODE_DEVICE) {
899 if (extension && extension->data[0] == 'c') {
900 ret |= S_IFCHR;
901 } else {
902 ret |= S_IFBLK;
903 }
904 }
905
906 if (!(ret&~0777)) {
907 ret |= S_IFREG;
908 }
909
910 if (mode & P9_STAT_MODE_SETUID) {
911 ret |= S_ISUID;
912 }
913 if (mode & P9_STAT_MODE_SETGID) {
914 ret |= S_ISGID;
915 }
916 if (mode & P9_STAT_MODE_SETVTX) {
917 ret |= S_ISVTX;
918 }
919
920 return ret;
921 }
922
923 static int donttouch_stat(V9fsStat *stat)
924 {
925 if (stat->type == -1 &&
926 stat->dev == -1 &&
927 stat->qid.type == -1 &&
928 stat->qid.version == -1 &&
929 stat->qid.path == -1 &&
930 stat->mode == -1 &&
931 stat->atime == -1 &&
932 stat->mtime == -1 &&
933 stat->length == -1 &&
934 !stat->name.size &&
935 !stat->uid.size &&
936 !stat->gid.size &&
937 !stat->muid.size &&
938 stat->n_uid == -1 &&
939 stat->n_gid == -1 &&
940 stat->n_muid == -1) {
941 return 1;
942 }
943
944 return 0;
945 }
946
947 static void v9fs_stat_free(V9fsStat *stat)
948 {
949 v9fs_string_free(&stat->name);
950 v9fs_string_free(&stat->uid);
951 v9fs_string_free(&stat->gid);
952 v9fs_string_free(&stat->muid);
953 v9fs_string_free(&stat->extension);
954 }
955
956 static uint32_t stat_to_v9mode(const struct stat *stbuf)
957 {
958 uint32_t mode;
959
960 mode = stbuf->st_mode & 0777;
961 if (S_ISDIR(stbuf->st_mode)) {
962 mode |= P9_STAT_MODE_DIR;
963 }
964
965 if (S_ISLNK(stbuf->st_mode)) {
966 mode |= P9_STAT_MODE_SYMLINK;
967 }
968
969 if (S_ISSOCK(stbuf->st_mode)) {
970 mode |= P9_STAT_MODE_SOCKET;
971 }
972
973 if (S_ISFIFO(stbuf->st_mode)) {
974 mode |= P9_STAT_MODE_NAMED_PIPE;
975 }
976
977 if (S_ISBLK(stbuf->st_mode) || S_ISCHR(stbuf->st_mode)) {
978 mode |= P9_STAT_MODE_DEVICE;
979 }
980
981 if (stbuf->st_mode & S_ISUID) {
982 mode |= P9_STAT_MODE_SETUID;
983 }
984
985 if (stbuf->st_mode & S_ISGID) {
986 mode |= P9_STAT_MODE_SETGID;
987 }
988
989 if (stbuf->st_mode & S_ISVTX) {
990 mode |= P9_STAT_MODE_SETVTX;
991 }
992
993 return mode;
994 }
995
996 static int stat_to_v9stat(V9fsState *s, V9fsString *name,
997 const struct stat *stbuf,
998 V9fsStat *v9stat)
999 {
1000 int err;
1001 const char *str;
1002
1003 memset(v9stat, 0, sizeof(*v9stat));
1004
1005 stat_to_qid(stbuf, &v9stat->qid);
1006 v9stat->mode = stat_to_v9mode(stbuf);
1007 v9stat->atime = stbuf->st_atime;
1008 v9stat->mtime = stbuf->st_mtime;
1009 v9stat->length = stbuf->st_size;
1010
1011 v9fs_string_null(&v9stat->uid);
1012 v9fs_string_null(&v9stat->gid);
1013 v9fs_string_null(&v9stat->muid);
1014
1015 v9stat->n_uid = stbuf->st_uid;
1016 v9stat->n_gid = stbuf->st_gid;
1017 v9stat->n_muid = 0;
1018
1019 v9fs_string_null(&v9stat->extension);
1020
1021 if (v9stat->mode & P9_STAT_MODE_SYMLINK) {
1022 err = v9fs_co_readlink(s, name, &v9stat->extension);
1023 if (err < 0) {
1024 return err;
1025 }
1026 } else if (v9stat->mode & P9_STAT_MODE_DEVICE) {
1027 v9fs_string_sprintf(&v9stat->extension, "%c %u %u",
1028 S_ISCHR(stbuf->st_mode) ? 'c' : 'b',
1029 major(stbuf->st_rdev), minor(stbuf->st_rdev));
1030 } else if (S_ISDIR(stbuf->st_mode) || S_ISREG(stbuf->st_mode)) {
1031 v9fs_string_sprintf(&v9stat->extension, "%s %lu",
1032 "HARDLINKCOUNT", (unsigned long)stbuf->st_nlink);
1033 }
1034
1035 str = strrchr(name->data, '/');
1036 if (str) {
1037 str += 1;
1038 } else {
1039 str = name->data;
1040 }
1041
1042 v9fs_string_sprintf(&v9stat->name, "%s", str);
1043
1044 v9stat->size = 61 +
1045 v9fs_string_size(&v9stat->name) +
1046 v9fs_string_size(&v9stat->uid) +
1047 v9fs_string_size(&v9stat->gid) +
1048 v9fs_string_size(&v9stat->muid) +
1049 v9fs_string_size(&v9stat->extension);
1050 return 0;
1051 }
1052
1053 #define P9_STATS_MODE 0x00000001ULL
1054 #define P9_STATS_NLINK 0x00000002ULL
1055 #define P9_STATS_UID 0x00000004ULL
1056 #define P9_STATS_GID 0x00000008ULL
1057 #define P9_STATS_RDEV 0x00000010ULL
1058 #define P9_STATS_ATIME 0x00000020ULL
1059 #define P9_STATS_MTIME 0x00000040ULL
1060 #define P9_STATS_CTIME 0x00000080ULL
1061 #define P9_STATS_INO 0x00000100ULL
1062 #define P9_STATS_SIZE 0x00000200ULL
1063 #define P9_STATS_BLOCKS 0x00000400ULL
1064
1065 #define P9_STATS_BTIME 0x00000800ULL
1066 #define P9_STATS_GEN 0x00001000ULL
1067 #define P9_STATS_DATA_VERSION 0x00002000ULL
1068
1069 #define P9_STATS_BASIC 0x000007ffULL /* Mask for fields up to BLOCKS */
1070 #define P9_STATS_ALL 0x00003fffULL /* Mask for All fields above */
1071
1072
1073 static void stat_to_v9stat_dotl(V9fsState *s, const struct stat *stbuf,
1074 V9fsStatDotl *v9lstat)
1075 {
1076 memset(v9lstat, 0, sizeof(*v9lstat));
1077
1078 v9lstat->st_mode = stbuf->st_mode;
1079 v9lstat->st_nlink = stbuf->st_nlink;
1080 v9lstat->st_uid = stbuf->st_uid;
1081 v9lstat->st_gid = stbuf->st_gid;
1082 v9lstat->st_rdev = stbuf->st_rdev;
1083 v9lstat->st_size = stbuf->st_size;
1084 v9lstat->st_blksize = stbuf->st_blksize;
1085 v9lstat->st_blocks = stbuf->st_blocks;
1086 v9lstat->st_atime_sec = stbuf->st_atime;
1087 v9lstat->st_atime_nsec = stbuf->st_atim.tv_nsec;
1088 v9lstat->st_mtime_sec = stbuf->st_mtime;
1089 v9lstat->st_mtime_nsec = stbuf->st_mtim.tv_nsec;
1090 v9lstat->st_ctime_sec = stbuf->st_ctime;
1091 v9lstat->st_ctime_nsec = stbuf->st_ctim.tv_nsec;
1092 /* Currently we only support BASIC fields in stat */
1093 v9lstat->st_result_mask = P9_STATS_BASIC;
1094
1095 stat_to_qid(stbuf, &v9lstat->qid);
1096 }
1097
1098 static struct iovec *adjust_sg(struct iovec *sg, int len, int *iovcnt)
1099 {
1100 while (len && *iovcnt) {
1101 if (len < sg->iov_len) {
1102 sg->iov_len -= len;
1103 sg->iov_base += len;
1104 len = 0;
1105 } else {
1106 len -= sg->iov_len;
1107 sg++;
1108 *iovcnt -= 1;
1109 }
1110 }
1111
1112 return sg;
1113 }
1114
1115 static struct iovec *cap_sg(struct iovec *sg, int cap, int *cnt)
1116 {
1117 int i;
1118 int total = 0;
1119
1120 for (i = 0; i < *cnt; i++) {
1121 if ((total + sg[i].iov_len) > cap) {
1122 sg[i].iov_len -= ((total + sg[i].iov_len) - cap);
1123 i++;
1124 break;
1125 }
1126 total += sg[i].iov_len;
1127 }
1128
1129 *cnt = i;
1130
1131 return sg;
1132 }
1133
1134 static void print_sg(struct iovec *sg, int cnt)
1135 {
1136 int i;
1137
1138 printf("sg[%d]: {", cnt);
1139 for (i = 0; i < cnt; i++) {
1140 if (i) {
1141 printf(", ");
1142 }
1143 printf("(%p, %zd)", sg[i].iov_base, sg[i].iov_len);
1144 }
1145 printf("}\n");
1146 }
1147
1148 static void v9fs_fix_path(V9fsString *dst, V9fsString *src, int len)
1149 {
1150 V9fsString str;
1151 v9fs_string_init(&str);
1152 v9fs_string_copy(&str, dst);
1153 v9fs_string_sprintf(dst, "%s%s", src->data, str.data+len);
1154 v9fs_string_free(&str);
1155 }
1156
1157 static void v9fs_version(void *opaque)
1158 {
1159 V9fsPDU *pdu = opaque;
1160 V9fsState *s = pdu->s;
1161 V9fsString version;
1162 size_t offset = 7;
1163
1164 pdu_unmarshal(pdu, offset, "ds", &s->msize, &version);
1165
1166 if (!strcmp(version.data, "9P2000.u")) {
1167 s->proto_version = V9FS_PROTO_2000U;
1168 } else if (!strcmp(version.data, "9P2000.L")) {
1169 s->proto_version = V9FS_PROTO_2000L;
1170 } else {
1171 v9fs_string_sprintf(&version, "unknown");
1172 }
1173
1174 offset += pdu_marshal(pdu, offset, "ds", s->msize, &version);
1175 complete_pdu(s, pdu, offset);
1176
1177 v9fs_string_free(&version);
1178 return;
1179 }
1180
1181 static void v9fs_attach(void *opaque)
1182 {
1183 V9fsPDU *pdu = opaque;
1184 V9fsState *s = pdu->s;
1185 int32_t fid, afid, n_uname;
1186 V9fsString uname, aname;
1187 V9fsFidState *fidp;
1188 V9fsQID qid;
1189 size_t offset = 7;
1190 ssize_t err;
1191
1192 pdu_unmarshal(pdu, offset, "ddssd", &fid, &afid, &uname, &aname, &n_uname);
1193
1194 fidp = alloc_fid(s, fid);
1195 if (fidp == NULL) {
1196 err = -EINVAL;
1197 goto out;
1198 }
1199
1200 fidp->uid = n_uname;
1201
1202 v9fs_string_sprintf(&fidp->path, "%s", "/");
1203 err = fid_to_qid(s, fidp, &qid);
1204 if (err) {
1205 err = -EINVAL;
1206 free_fid(s, fid);
1207 goto out;
1208 }
1209
1210 offset += pdu_marshal(pdu, offset, "Q", &qid);
1211
1212 err = offset;
1213 out:
1214 complete_pdu(s, pdu, err);
1215 v9fs_string_free(&uname);
1216 v9fs_string_free(&aname);
1217 }
1218
1219 static void v9fs_stat_post_lstat(V9fsState *s, V9fsStatState *vs, int err)
1220 {
1221 if (err == -1) {
1222 err = -errno;
1223 goto out;
1224 }
1225
1226 err = stat_to_v9stat(s, &vs->fidp->path, &vs->stbuf, &vs->v9stat);
1227 if (err) {
1228 goto out;
1229 }
1230 vs->offset += pdu_marshal(vs->pdu, vs->offset, "wS", 0, &vs->v9stat);
1231 err = vs->offset;
1232
1233 out:
1234 complete_pdu(s, vs->pdu, err);
1235 v9fs_stat_free(&vs->v9stat);
1236 qemu_free(vs);
1237 }
1238
1239 static void v9fs_stat(void *opaque)
1240 {
1241 V9fsPDU *pdu = opaque;
1242 V9fsState *s = pdu->s;
1243 int32_t fid;
1244 V9fsStatState *vs;
1245 ssize_t err = 0;
1246
1247 vs = qemu_malloc(sizeof(*vs));
1248 vs->pdu = pdu;
1249 vs->offset = 7;
1250
1251 memset(&vs->v9stat, 0, sizeof(vs->v9stat));
1252
1253 pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
1254
1255 vs->fidp = lookup_fid(s, fid);
1256 if (vs->fidp == NULL) {
1257 err = -ENOENT;
1258 goto out;
1259 }
1260
1261 err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1262 v9fs_stat_post_lstat(s, vs, err);
1263 return;
1264
1265 out:
1266 complete_pdu(s, vs->pdu, err);
1267 v9fs_stat_free(&vs->v9stat);
1268 qemu_free(vs);
1269 }
1270
1271 static void v9fs_getattr(void *opaque)
1272 {
1273 int32_t fid;
1274 size_t offset = 7;
1275 ssize_t retval = 0;
1276 struct stat stbuf;
1277 V9fsFidState *fidp;
1278 uint64_t request_mask;
1279 V9fsStatDotl v9stat_dotl;
1280 V9fsPDU *pdu = opaque;
1281 V9fsState *s = pdu->s;
1282
1283 pdu_unmarshal(pdu, offset, "dq", &fid, &request_mask);
1284
1285 fidp = lookup_fid(s, fid);
1286 if (fidp == NULL) {
1287 retval = -ENOENT;
1288 goto out;
1289 }
1290 /*
1291 * Currently we only support BASIC fields in stat, so there is no
1292 * need to look at request_mask.
1293 */
1294 retval = v9fs_co_lstat(s, &fidp->path, &stbuf);
1295 if (retval < 0) {
1296 goto out;
1297 }
1298 stat_to_v9stat_dotl(s, &stbuf, &v9stat_dotl);
1299 retval = offset;
1300 retval += pdu_marshal(pdu, offset, "A", &v9stat_dotl);
1301 out:
1302 complete_pdu(s, pdu, retval);
1303 }
1304
1305 /* From Linux kernel code */
1306 #define ATTR_MODE (1 << 0)
1307 #define ATTR_UID (1 << 1)
1308 #define ATTR_GID (1 << 2)
1309 #define ATTR_SIZE (1 << 3)
1310 #define ATTR_ATIME (1 << 4)
1311 #define ATTR_MTIME (1 << 5)
1312 #define ATTR_CTIME (1 << 6)
1313 #define ATTR_MASK 127
1314 #define ATTR_ATIME_SET (1 << 7)
1315 #define ATTR_MTIME_SET (1 << 8)
1316
1317 static void v9fs_setattr(void *opaque)
1318 {
1319 int err = 0;
1320 int32_t fid;
1321 V9fsFidState *fidp;
1322 size_t offset = 7;
1323 V9fsIattr v9iattr;
1324 V9fsPDU *pdu = opaque;
1325 V9fsState *s = pdu->s;
1326
1327 pdu_unmarshal(pdu, offset, "dI", &fid, &v9iattr);
1328
1329 fidp = lookup_fid(s, fid);
1330 if (fidp == NULL) {
1331 err = -EINVAL;
1332 goto out;
1333 }
1334 if (v9iattr.valid & ATTR_MODE) {
1335 err = v9fs_co_chmod(s, &fidp->path, v9iattr.mode);
1336 if (err < 0) {
1337 goto out;
1338 }
1339 }
1340 if (v9iattr.valid & (ATTR_ATIME | ATTR_MTIME)) {
1341 struct timespec times[2];
1342 if (v9iattr.valid & ATTR_ATIME) {
1343 if (v9iattr.valid & ATTR_ATIME_SET) {
1344 times[0].tv_sec = v9iattr.atime_sec;
1345 times[0].tv_nsec = v9iattr.atime_nsec;
1346 } else {
1347 times[0].tv_nsec = UTIME_NOW;
1348 }
1349 } else {
1350 times[0].tv_nsec = UTIME_OMIT;
1351 }
1352 if (v9iattr.valid & ATTR_MTIME) {
1353 if (v9iattr.valid & ATTR_MTIME_SET) {
1354 times[1].tv_sec = v9iattr.mtime_sec;
1355 times[1].tv_nsec = v9iattr.mtime_nsec;
1356 } else {
1357 times[1].tv_nsec = UTIME_NOW;
1358 }
1359 } else {
1360 times[1].tv_nsec = UTIME_OMIT;
1361 }
1362 err = v9fs_co_utimensat(s, &fidp->path, times);
1363 if (err < 0) {
1364 goto out;
1365 }
1366 }
1367 /*
1368 * If the only valid entry in iattr is ctime we can call
1369 * chown(-1,-1) to update the ctime of the file
1370 */
1371 if ((v9iattr.valid & (ATTR_UID | ATTR_GID)) ||
1372 ((v9iattr.valid & ATTR_CTIME)
1373 && !((v9iattr.valid & ATTR_MASK) & ~ATTR_CTIME))) {
1374 if (!(v9iattr.valid & ATTR_UID)) {
1375 v9iattr.uid = -1;
1376 }
1377 if (!(v9iattr.valid & ATTR_GID)) {
1378 v9iattr.gid = -1;
1379 }
1380 err = v9fs_co_chown(s, &fidp->path, v9iattr.uid,
1381 v9iattr.gid);
1382 if (err < 0) {
1383 goto out;
1384 }
1385 }
1386 if (v9iattr.valid & (ATTR_SIZE)) {
1387 err = v9fs_co_truncate(s, &fidp->path, v9iattr.size);
1388 if (err < 0) {
1389 goto out;
1390 }
1391 }
1392 err = offset;
1393 out:
1394 complete_pdu(s, pdu, err);
1395 }
1396
1397 static void v9fs_walk_complete(V9fsState *s, V9fsWalkState *vs, int err)
1398 {
1399 complete_pdu(s, vs->pdu, err);
1400
1401 if (vs->nwnames && vs->nwnames <= P9_MAXWELEM) {
1402 for (vs->name_idx = 0; vs->name_idx < vs->nwnames; vs->name_idx++) {
1403 v9fs_string_free(&vs->wnames[vs->name_idx]);
1404 }
1405
1406 qemu_free(vs->wnames);
1407 qemu_free(vs->qids);
1408 }
1409 }
1410
1411 static void v9fs_walk_marshal(V9fsWalkState *vs)
1412 {
1413 int i;
1414 vs->offset = 7;
1415 vs->offset += pdu_marshal(vs->pdu, vs->offset, "w", vs->nwnames);
1416
1417 for (i = 0; i < vs->nwnames; i++) {
1418 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qids[i]);
1419 }
1420 }
1421
1422 static void v9fs_walk_post_newfid_lstat(V9fsState *s, V9fsWalkState *vs,
1423 int err)
1424 {
1425 if (err == -1) {
1426 free_fid(s, vs->newfidp->fid);
1427 v9fs_string_free(&vs->path);
1428 err = -ENOENT;
1429 goto out;
1430 }
1431
1432 stat_to_qid(&vs->stbuf, &vs->qids[vs->name_idx]);
1433
1434 vs->name_idx++;
1435 if (vs->name_idx < vs->nwnames) {
1436 v9fs_string_sprintf(&vs->path, "%s/%s", vs->newfidp->path.data,
1437 vs->wnames[vs->name_idx].data);
1438 v9fs_string_copy(&vs->newfidp->path, &vs->path);
1439
1440 err = v9fs_do_lstat(s, &vs->newfidp->path, &vs->stbuf);
1441 v9fs_walk_post_newfid_lstat(s, vs, err);
1442 return;
1443 }
1444
1445 v9fs_string_free(&vs->path);
1446 v9fs_walk_marshal(vs);
1447 err = vs->offset;
1448 out:
1449 v9fs_walk_complete(s, vs, err);
1450 }
1451
1452 static void v9fs_walk_post_oldfid_lstat(V9fsState *s, V9fsWalkState *vs,
1453 int err)
1454 {
1455 if (err == -1) {
1456 v9fs_string_free(&vs->path);
1457 err = -ENOENT;
1458 goto out;
1459 }
1460
1461 stat_to_qid(&vs->stbuf, &vs->qids[vs->name_idx]);
1462 vs->name_idx++;
1463 if (vs->name_idx < vs->nwnames) {
1464
1465 v9fs_string_sprintf(&vs->path, "%s/%s",
1466 vs->fidp->path.data, vs->wnames[vs->name_idx].data);
1467 v9fs_string_copy(&vs->fidp->path, &vs->path);
1468
1469 err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1470 v9fs_walk_post_oldfid_lstat(s, vs, err);
1471 return;
1472 }
1473
1474 v9fs_string_free(&vs->path);
1475 v9fs_walk_marshal(vs);
1476 err = vs->offset;
1477 out:
1478 v9fs_walk_complete(s, vs, err);
1479 }
1480
1481 static void v9fs_walk(void *opaque)
1482 {
1483 V9fsPDU *pdu = opaque;
1484 V9fsState *s = pdu->s;
1485 int32_t fid, newfid;
1486 V9fsWalkState *vs;
1487 int err = 0;
1488 int i;
1489
1490 vs = qemu_malloc(sizeof(*vs));
1491 vs->pdu = pdu;
1492 vs->wnames = NULL;
1493 vs->qids = NULL;
1494 vs->offset = 7;
1495
1496 vs->offset += pdu_unmarshal(vs->pdu, vs->offset, "ddw", &fid,
1497 &newfid, &vs->nwnames);
1498
1499 if (vs->nwnames && vs->nwnames <= P9_MAXWELEM) {
1500 vs->wnames = qemu_mallocz(sizeof(vs->wnames[0]) * vs->nwnames);
1501
1502 vs->qids = qemu_mallocz(sizeof(vs->qids[0]) * vs->nwnames);
1503
1504 for (i = 0; i < vs->nwnames; i++) {
1505 vs->offset += pdu_unmarshal(vs->pdu, vs->offset, "s",
1506 &vs->wnames[i]);
1507 }
1508 } else if (vs->nwnames > P9_MAXWELEM) {
1509 err = -EINVAL;
1510 goto out;
1511 }
1512
1513 vs->fidp = lookup_fid(s, fid);
1514 if (vs->fidp == NULL) {
1515 err = -ENOENT;
1516 goto out;
1517 }
1518
1519 /* FIXME: is this really valid? */
1520 if (fid == newfid) {
1521
1522 BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
1523 v9fs_string_init(&vs->path);
1524 vs->name_idx = 0;
1525
1526 if (vs->name_idx < vs->nwnames) {
1527 v9fs_string_sprintf(&vs->path, "%s/%s",
1528 vs->fidp->path.data, vs->wnames[vs->name_idx].data);
1529 v9fs_string_copy(&vs->fidp->path, &vs->path);
1530
1531 err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1532 v9fs_walk_post_oldfid_lstat(s, vs, err);
1533 return;
1534 }
1535 } else {
1536 vs->newfidp = alloc_fid(s, newfid);
1537 if (vs->newfidp == NULL) {
1538 err = -EINVAL;
1539 goto out;
1540 }
1541
1542 vs->newfidp->uid = vs->fidp->uid;
1543 v9fs_string_init(&vs->path);
1544 vs->name_idx = 0;
1545 v9fs_string_copy(&vs->newfidp->path, &vs->fidp->path);
1546
1547 if (vs->name_idx < vs->nwnames) {
1548 v9fs_string_sprintf(&vs->path, "%s/%s", vs->newfidp->path.data,
1549 vs->wnames[vs->name_idx].data);
1550 v9fs_string_copy(&vs->newfidp->path, &vs->path);
1551
1552 err = v9fs_do_lstat(s, &vs->newfidp->path, &vs->stbuf);
1553 v9fs_walk_post_newfid_lstat(s, vs, err);
1554 return;
1555 }
1556 }
1557
1558 v9fs_walk_marshal(vs);
1559 err = vs->offset;
1560 out:
1561 v9fs_walk_complete(s, vs, err);
1562 }
1563
1564 static int32_t get_iounit(V9fsState *s, V9fsString *name)
1565 {
1566 struct statfs stbuf;
1567 int32_t iounit = 0;
1568
1569 /*
1570 * iounit should be multiples of f_bsize (host filesystem block size
1571 * and as well as less than (client msize - P9_IOHDRSZ))
1572 */
1573 if (!v9fs_do_statfs(s, name, &stbuf)) {
1574 iounit = stbuf.f_bsize;
1575 iounit *= (s->msize - P9_IOHDRSZ)/stbuf.f_bsize;
1576 }
1577
1578 if (!iounit) {
1579 iounit = s->msize - P9_IOHDRSZ;
1580 }
1581 return iounit;
1582 }
1583
1584 static void v9fs_open_post_opendir(V9fsState *s, V9fsOpenState *vs, int err)
1585 {
1586 if (vs->fidp->fs.dir == NULL) {
1587 err = -errno;
1588 goto out;
1589 }
1590 vs->fidp->fid_type = P9_FID_DIR;
1591 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, 0);
1592 err = vs->offset;
1593 out:
1594 complete_pdu(s, vs->pdu, err);
1595 qemu_free(vs);
1596
1597 }
1598
1599 static void v9fs_open_post_getiounit(V9fsState *s, V9fsOpenState *vs)
1600 {
1601 int err;
1602 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, vs->iounit);
1603 err = vs->offset;
1604 complete_pdu(s, vs->pdu, err);
1605 qemu_free(vs);
1606 }
1607
1608 static void v9fs_open_post_open(V9fsState *s, V9fsOpenState *vs, int err)
1609 {
1610 if (vs->fidp->fs.fd == -1) {
1611 err = -errno;
1612 goto out;
1613 }
1614 vs->fidp->fid_type = P9_FID_FILE;
1615 vs->iounit = get_iounit(s, &vs->fidp->path);
1616 v9fs_open_post_getiounit(s, vs);
1617 return;
1618 out:
1619 complete_pdu(s, vs->pdu, err);
1620 qemu_free(vs);
1621 }
1622
1623 static void v9fs_open_post_lstat(V9fsState *s, V9fsOpenState *vs, int err)
1624 {
1625 int flags;
1626
1627 if (err) {
1628 err = -errno;
1629 goto out;
1630 }
1631
1632 stat_to_qid(&vs->stbuf, &vs->qid);
1633
1634 if (S_ISDIR(vs->stbuf.st_mode)) {
1635 vs->fidp->fs.dir = v9fs_do_opendir(s, &vs->fidp->path);
1636 v9fs_open_post_opendir(s, vs, err);
1637 } else {
1638 if (s->proto_version == V9FS_PROTO_2000L) {
1639 flags = vs->mode;
1640 flags &= ~(O_NOCTTY | O_ASYNC | O_CREAT);
1641 /* Ignore direct disk access hint until the server supports it. */
1642 flags &= ~O_DIRECT;
1643 } else {
1644 flags = omode_to_uflags(vs->mode);
1645 }
1646 vs->fidp->fs.fd = v9fs_do_open(s, &vs->fidp->path, flags);
1647 v9fs_open_post_open(s, vs, err);
1648 }
1649 return;
1650 out:
1651 complete_pdu(s, vs->pdu, err);
1652 qemu_free(vs);
1653 }
1654
1655 static void v9fs_open(void *opaque)
1656 {
1657 V9fsPDU *pdu = opaque;
1658 V9fsState *s = pdu->s;
1659 int32_t fid;
1660 V9fsOpenState *vs;
1661 ssize_t err = 0;
1662
1663 vs = qemu_malloc(sizeof(*vs));
1664 vs->pdu = pdu;
1665 vs->offset = 7;
1666 vs->mode = 0;
1667
1668 if (s->proto_version == V9FS_PROTO_2000L) {
1669 pdu_unmarshal(vs->pdu, vs->offset, "dd", &fid, &vs->mode);
1670 } else {
1671 pdu_unmarshal(vs->pdu, vs->offset, "db", &fid, &vs->mode);
1672 }
1673
1674 vs->fidp = lookup_fid(s, fid);
1675 if (vs->fidp == NULL) {
1676 err = -ENOENT;
1677 goto out;
1678 }
1679
1680 BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
1681
1682 err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1683
1684 v9fs_open_post_lstat(s, vs, err);
1685 return;
1686 out:
1687 complete_pdu(s, pdu, err);
1688 qemu_free(vs);
1689 }
1690
1691 static void v9fs_post_lcreate(V9fsState *s, V9fsLcreateState *vs, int err)
1692 {
1693 if (err == 0) {
1694 v9fs_string_copy(&vs->fidp->path, &vs->fullname);
1695 stat_to_qid(&vs->stbuf, &vs->qid);
1696 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid,
1697 vs->iounit);
1698 err = vs->offset;
1699 } else {
1700 vs->fidp->fid_type = P9_FID_NONE;
1701 err = -errno;
1702 if (vs->fidp->fs.fd > 0) {
1703 close(vs->fidp->fs.fd);
1704 }
1705 }
1706
1707 complete_pdu(s, vs->pdu, err);
1708 v9fs_string_free(&vs->name);
1709 v9fs_string_free(&vs->fullname);
1710 qemu_free(vs);
1711 }
1712
1713 static void v9fs_lcreate_post_get_iounit(V9fsState *s, V9fsLcreateState *vs,
1714 int err)
1715 {
1716 if (err) {
1717 err = -errno;
1718 goto out;
1719 }
1720 err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
1721
1722 out:
1723 v9fs_post_lcreate(s, vs, err);
1724 }
1725
1726 static void v9fs_lcreate_post_do_open2(V9fsState *s, V9fsLcreateState *vs,
1727 int err)
1728 {
1729 if (vs->fidp->fs.fd == -1) {
1730 err = -errno;
1731 goto out;
1732 }
1733 vs->fidp->fid_type = P9_FID_FILE;
1734 vs->iounit = get_iounit(s, &vs->fullname);
1735 v9fs_lcreate_post_get_iounit(s, vs, err);
1736 return;
1737
1738 out:
1739 v9fs_post_lcreate(s, vs, err);
1740 }
1741
1742 static void v9fs_lcreate(void *opaque)
1743 {
1744 V9fsPDU *pdu = opaque;
1745 V9fsState *s = pdu->s;
1746 int32_t dfid, flags, mode;
1747 gid_t gid;
1748 V9fsLcreateState *vs;
1749 ssize_t err = 0;
1750
1751 vs = qemu_malloc(sizeof(*vs));
1752 vs->pdu = pdu;
1753 vs->offset = 7;
1754
1755 v9fs_string_init(&vs->fullname);
1756
1757 pdu_unmarshal(vs->pdu, vs->offset, "dsddd", &dfid, &vs->name, &flags,
1758 &mode, &gid);
1759
1760 vs->fidp = lookup_fid(s, dfid);
1761 if (vs->fidp == NULL) {
1762 err = -ENOENT;
1763 goto out;
1764 }
1765
1766 v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->fidp->path.data,
1767 vs->name.data);
1768
1769 /* Ignore direct disk access hint until the server supports it. */
1770 flags &= ~O_DIRECT;
1771
1772 vs->fidp->fs.fd = v9fs_do_open2(s, vs->fullname.data, vs->fidp->uid,
1773 gid, flags, mode);
1774 v9fs_lcreate_post_do_open2(s, vs, err);
1775 return;
1776
1777 out:
1778 complete_pdu(s, vs->pdu, err);
1779 v9fs_string_free(&vs->name);
1780 qemu_free(vs);
1781 }
1782
1783 static void v9fs_post_do_fsync(V9fsState *s, V9fsPDU *pdu, int err)
1784 {
1785 if (err == -1) {
1786 err = -errno;
1787 }
1788 complete_pdu(s, pdu, err);
1789 }
1790
1791 static void v9fs_fsync(void *opaque)
1792 {
1793 V9fsPDU *pdu = opaque;
1794 V9fsState *s = pdu->s;
1795 int32_t fid;
1796 size_t offset = 7;
1797 V9fsFidState *fidp;
1798 int datasync;
1799 int err;
1800
1801 pdu_unmarshal(pdu, offset, "dd", &fid, &datasync);
1802 fidp = lookup_fid(s, fid);
1803 if (fidp == NULL) {
1804 err = -ENOENT;
1805 v9fs_post_do_fsync(s, pdu, err);
1806 return;
1807 }
1808 err = v9fs_do_fsync(s, fidp->fs.fd, datasync);
1809 v9fs_post_do_fsync(s, pdu, err);
1810 }
1811
1812 static void v9fs_clunk(void *opaque)
1813 {
1814 V9fsPDU *pdu = opaque;
1815 V9fsState *s = pdu->s;
1816 int32_t fid;
1817 size_t offset = 7;
1818 int err;
1819
1820 pdu_unmarshal(pdu, offset, "d", &fid);
1821
1822 err = free_fid(s, fid);
1823 if (err < 0) {
1824 goto out;
1825 }
1826
1827 offset = 7;
1828 err = offset;
1829 out:
1830 complete_pdu(s, pdu, err);
1831 }
1832
1833 static void v9fs_read_post_readdir(V9fsState *, V9fsReadState *, ssize_t);
1834
1835 static void v9fs_read_post_seekdir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1836 {
1837 if (err) {
1838 goto out;
1839 }
1840 vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
1841 vs->offset += vs->count;
1842 err = vs->offset;
1843 out:
1844 complete_pdu(s, vs->pdu, err);
1845 v9fs_stat_free(&vs->v9stat);
1846 v9fs_string_free(&vs->name);
1847 qemu_free(vs);
1848 return;
1849 }
1850
1851 static void v9fs_read_post_dir_lstat(V9fsState *s, V9fsReadState *vs,
1852 ssize_t err)
1853 {
1854 if (err) {
1855 err = -errno;
1856 goto out;
1857 }
1858 err = stat_to_v9stat(s, &vs->name, &vs->stbuf, &vs->v9stat);
1859 if (err) {
1860 goto out;
1861 }
1862
1863 vs->len = pdu_marshal(vs->pdu, vs->offset + 4 + vs->count, "S",
1864 &vs->v9stat);
1865 if ((vs->len != (vs->v9stat.size + 2)) ||
1866 ((vs->count + vs->len) > vs->max_count)) {
1867 v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->dir_pos);
1868 v9fs_read_post_seekdir(s, vs, err);
1869 return;
1870 }
1871 vs->count += vs->len;
1872 v9fs_stat_free(&vs->v9stat);
1873 v9fs_string_free(&vs->name);
1874 vs->dir_pos = vs->dent->d_off;
1875 v9fs_co_readdir(s, vs->fidp, &vs->dent);
1876 v9fs_read_post_readdir(s, vs, err);
1877 return;
1878 out:
1879 v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->dir_pos);
1880 v9fs_read_post_seekdir(s, vs, err);
1881 return;
1882
1883 }
1884
1885 static void v9fs_read_post_readdir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1886 {
1887 if (vs->dent) {
1888 memset(&vs->v9stat, 0, sizeof(vs->v9stat));
1889 v9fs_string_init(&vs->name);
1890 v9fs_string_sprintf(&vs->name, "%s/%s", vs->fidp->path.data,
1891 vs->dent->d_name);
1892 err = v9fs_do_lstat(s, &vs->name, &vs->stbuf);
1893 v9fs_read_post_dir_lstat(s, vs, err);
1894 return;
1895 }
1896
1897 vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
1898 vs->offset += vs->count;
1899 err = vs->offset;
1900 complete_pdu(s, vs->pdu, err);
1901 qemu_free(vs);
1902 return;
1903 }
1904
1905 static void v9fs_read_post_telldir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1906 {
1907 v9fs_co_readdir(s, vs->fidp, &vs->dent);
1908 v9fs_read_post_readdir(s, vs, err);
1909 return;
1910 }
1911
1912 static void v9fs_read_post_rewinddir(V9fsState *s, V9fsReadState *vs,
1913 ssize_t err)
1914 {
1915 vs->dir_pos = v9fs_do_telldir(s, vs->fidp->fs.dir);
1916 v9fs_read_post_telldir(s, vs, err);
1917 return;
1918 }
1919
1920 static void v9fs_read_post_preadv(V9fsState *s, V9fsReadState *vs, ssize_t err)
1921 {
1922 if (err < 0) {
1923 /* IO error return the error */
1924 err = -errno;
1925 goto out;
1926 }
1927 vs->total += vs->len;
1928 vs->sg = adjust_sg(vs->sg, vs->len, &vs->cnt);
1929 if (vs->total < vs->count && vs->len > 0) {
1930 do {
1931 if (0) {
1932 print_sg(vs->sg, vs->cnt);
1933 }
1934 vs->len = v9fs_do_preadv(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
1935 vs->off);
1936 if (vs->len > 0) {
1937 vs->off += vs->len;
1938 }
1939 } while (vs->len == -1 && errno == EINTR);
1940 if (vs->len == -1) {
1941 err = -errno;
1942 }
1943 v9fs_read_post_preadv(s, vs, err);
1944 return;
1945 }
1946 vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->total);
1947 vs->offset += vs->count;
1948 err = vs->offset;
1949
1950 out:
1951 complete_pdu(s, vs->pdu, err);
1952 qemu_free(vs);
1953 }
1954
1955 static void v9fs_xattr_read(V9fsState *s, V9fsReadState *vs)
1956 {
1957 ssize_t err = 0;
1958 int read_count;
1959 int64_t xattr_len;
1960
1961 xattr_len = vs->fidp->fs.xattr.len;
1962 read_count = xattr_len - vs->off;
1963 if (read_count > vs->count) {
1964 read_count = vs->count;
1965 } else if (read_count < 0) {
1966 /*
1967 * read beyond XATTR value
1968 */
1969 read_count = 0;
1970 }
1971 vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", read_count);
1972 vs->offset += pdu_pack(vs->pdu, vs->offset,
1973 ((char *)vs->fidp->fs.xattr.value) + vs->off,
1974 read_count);
1975 err = vs->offset;
1976 complete_pdu(s, vs->pdu, err);
1977 qemu_free(vs);
1978 }
1979
1980 static void v9fs_read(void *opaque)
1981 {
1982 V9fsPDU *pdu = opaque;
1983 V9fsState *s = pdu->s;
1984 int32_t fid;
1985 V9fsReadState *vs;
1986 ssize_t err = 0;
1987
1988 vs = qemu_malloc(sizeof(*vs));
1989 vs->pdu = pdu;
1990 vs->offset = 7;
1991 vs->total = 0;
1992 vs->len = 0;
1993 vs->count = 0;
1994
1995 pdu_unmarshal(vs->pdu, vs->offset, "dqd", &fid, &vs->off, &vs->count);
1996
1997 vs->fidp = lookup_fid(s, fid);
1998 if (vs->fidp == NULL) {
1999 err = -EINVAL;
2000 goto out;
2001 }
2002
2003 if (vs->fidp->fid_type == P9_FID_DIR) {
2004 vs->max_count = vs->count;
2005 vs->count = 0;
2006 if (vs->off == 0) {
2007 v9fs_do_rewinddir(s, vs->fidp->fs.dir);
2008 }
2009 v9fs_read_post_rewinddir(s, vs, err);
2010 return;
2011 } else if (vs->fidp->fid_type == P9_FID_FILE) {
2012 vs->sg = vs->iov;
2013 pdu_marshal(vs->pdu, vs->offset + 4, "v", vs->sg, &vs->cnt);
2014 vs->sg = cap_sg(vs->sg, vs->count, &vs->cnt);
2015 if (vs->total <= vs->count) {
2016 vs->len = v9fs_do_preadv(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2017 vs->off);
2018 if (vs->len > 0) {
2019 vs->off += vs->len;
2020 }
2021 err = vs->len;
2022 v9fs_read_post_preadv(s, vs, err);
2023 }
2024 return;
2025 } else if (vs->fidp->fid_type == P9_FID_XATTR) {
2026 v9fs_xattr_read(s, vs);
2027 return;
2028 } else {
2029 err = -EINVAL;
2030 }
2031 out:
2032 complete_pdu(s, pdu, err);
2033 qemu_free(vs);
2034 }
2035
2036 static size_t v9fs_readdir_data_size(V9fsString *name)
2037 {
2038 /*
2039 * Size of each dirent on the wire: size of qid (13) + size of offset (8)
2040 * size of type (1) + size of name.size (2) + strlen(name.data)
2041 */
2042 return 24 + v9fs_string_size(name);
2043 }
2044
2045 static int v9fs_do_readdir(V9fsState *s, V9fsPDU *pdu,
2046 V9fsFidState *fidp, int32_t max_count)
2047 {
2048 size_t size;
2049 V9fsQID qid;
2050 V9fsString name;
2051 int len, err = 0;
2052 int32_t count = 0;
2053 off_t saved_dir_pos;
2054 struct dirent *dent;
2055
2056 /* save the directory position */
2057 saved_dir_pos = v9fs_co_telldir(s, fidp);
2058 if (saved_dir_pos < 0) {
2059 return saved_dir_pos;
2060 }
2061 while (1) {
2062 err = v9fs_co_readdir(s, fidp, &dent);
2063 if (err || !dent) {
2064 break;
2065 }
2066 v9fs_string_init(&name);
2067 v9fs_string_sprintf(&name, "%s", dent->d_name);
2068 if ((count + v9fs_readdir_data_size(&name)) > max_count) {
2069 /* Ran out of buffer. Set dir back to old position and return */
2070 v9fs_co_seekdir(s, fidp, saved_dir_pos);
2071 v9fs_string_free(&name);
2072 return count;
2073 }
2074 /*
2075 * Fill up just the path field of qid because the client uses
2076 * only that. To fill the entire qid structure we will have
2077 * to stat each dirent found, which is expensive
2078 */
2079 size = MIN(sizeof(dent->d_ino), sizeof(qid.path));
2080 memcpy(&qid.path, &dent->d_ino, size);
2081 /* Fill the other fields with dummy values */
2082 qid.type = 0;
2083 qid.version = 0;
2084
2085 /* 11 = 7 + 4 (7 = start offset, 4 = space for storing count) */
2086 len = pdu_marshal(pdu, 11 + count, "Qqbs",
2087 &qid, dent->d_off,
2088 dent->d_type, &name);
2089 count += len;
2090 v9fs_string_free(&name);
2091 saved_dir_pos = dent->d_off;
2092 }
2093 if (err < 0) {
2094 return err;
2095 }
2096 return count;
2097 }
2098
2099 static void v9fs_readdir(void *opaque)
2100 {
2101 int32_t fid;
2102 V9fsFidState *fidp;
2103 ssize_t retval = 0;
2104 size_t offset = 7;
2105 int64_t initial_offset;
2106 int32_t count, max_count;
2107 V9fsPDU *pdu = opaque;
2108 V9fsState *s = pdu->s;
2109
2110 pdu_unmarshal(pdu, offset, "dqd", &fid, &initial_offset, &max_count);
2111
2112 fidp = lookup_fid(s, fid);
2113 if (fidp == NULL || !fidp->fs.dir) {
2114 retval = -EINVAL;
2115 goto out;
2116 }
2117 if (initial_offset == 0) {
2118 v9fs_co_rewinddir(s, fidp);
2119 } else {
2120 v9fs_co_seekdir(s, fidp, initial_offset);
2121 }
2122 count = v9fs_do_readdir(s, pdu, fidp, max_count);
2123 if (count < 0) {
2124 retval = count;
2125 goto out;
2126 }
2127 retval = offset;
2128 retval += pdu_marshal(pdu, offset, "d", count);
2129 retval += count;
2130 out:
2131 complete_pdu(s, pdu, retval);
2132 }
2133
2134 static void v9fs_write_post_pwritev(V9fsState *s, V9fsWriteState *vs,
2135 ssize_t err)
2136 {
2137 if (err < 0) {
2138 /* IO error return the error */
2139 err = -errno;
2140 goto out;
2141 }
2142 vs->total += vs->len;
2143 vs->sg = adjust_sg(vs->sg, vs->len, &vs->cnt);
2144 if (vs->total < vs->count && vs->len > 0) {
2145 do {
2146 if (0) {
2147 print_sg(vs->sg, vs->cnt);
2148 }
2149 vs->len = v9fs_do_pwritev(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2150 vs->off);
2151 if (vs->len > 0) {
2152 vs->off += vs->len;
2153 }
2154 } while (vs->len == -1 && errno == EINTR);
2155 if (vs->len == -1) {
2156 err = -errno;
2157 }
2158 v9fs_write_post_pwritev(s, vs, err);
2159 return;
2160 }
2161 vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->total);
2162 err = vs->offset;
2163 out:
2164 complete_pdu(s, vs->pdu, err);
2165 qemu_free(vs);
2166 }
2167
2168 static void v9fs_xattr_write(V9fsState *s, V9fsWriteState *vs)
2169 {
2170 int i, to_copy;
2171 ssize_t err = 0;
2172 int write_count;
2173 int64_t xattr_len;
2174
2175 xattr_len = vs->fidp->fs.xattr.len;
2176 write_count = xattr_len - vs->off;
2177 if (write_count > vs->count) {
2178 write_count = vs->count;
2179 } else if (write_count < 0) {
2180 /*
2181 * write beyond XATTR value len specified in
2182 * xattrcreate
2183 */
2184 err = -ENOSPC;
2185 goto out;
2186 }
2187 vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", write_count);
2188 err = vs->offset;
2189 vs->fidp->fs.xattr.copied_len += write_count;
2190 /*
2191 * Now copy the content from sg list
2192 */
2193 for (i = 0; i < vs->cnt; i++) {
2194 if (write_count > vs->sg[i].iov_len) {
2195 to_copy = vs->sg[i].iov_len;
2196 } else {
2197 to_copy = write_count;
2198 }
2199 memcpy((char *)vs->fidp->fs.xattr.value + vs->off,
2200 vs->sg[i].iov_base, to_copy);
2201 /* updating vs->off since we are not using below */
2202 vs->off += to_copy;
2203 write_count -= to_copy;
2204 }
2205 out:
2206 complete_pdu(s, vs->pdu, err);
2207 qemu_free(vs);
2208 }
2209
2210 static void v9fs_write(void *opaque)
2211 {
2212 V9fsPDU *pdu = opaque;
2213 V9fsState *s = pdu->s;
2214 int32_t fid;
2215 V9fsWriteState *vs;
2216 ssize_t err;
2217
2218 vs = qemu_malloc(sizeof(*vs));
2219
2220 vs->pdu = pdu;
2221 vs->offset = 7;
2222 vs->sg = vs->iov;
2223 vs->total = 0;
2224 vs->len = 0;
2225
2226 pdu_unmarshal(vs->pdu, vs->offset, "dqdv", &fid, &vs->off, &vs->count,
2227 vs->sg, &vs->cnt);
2228
2229 vs->fidp = lookup_fid(s, fid);
2230 if (vs->fidp == NULL) {
2231 err = -EINVAL;
2232 goto out;
2233 }
2234
2235 if (vs->fidp->fid_type == P9_FID_FILE) {
2236 if (vs->fidp->fs.fd == -1) {
2237 err = -EINVAL;
2238 goto out;
2239 }
2240 } else if (vs->fidp->fid_type == P9_FID_XATTR) {
2241 /*
2242 * setxattr operation
2243 */
2244 v9fs_xattr_write(s, vs);
2245 return;
2246 } else {
2247 err = -EINVAL;
2248 goto out;
2249 }
2250 vs->sg = cap_sg(vs->sg, vs->count, &vs->cnt);
2251 if (vs->total <= vs->count) {
2252 vs->len = v9fs_do_pwritev(s, vs->fidp->fs.fd, vs->sg, vs->cnt, vs->off);
2253 if (vs->len > 0) {
2254 vs->off += vs->len;
2255 }
2256 err = vs->len;
2257 v9fs_write_post_pwritev(s, vs, err);
2258 }
2259 return;
2260 out:
2261 complete_pdu(s, vs->pdu, err);
2262 qemu_free(vs);
2263 }
2264
2265 static void v9fs_create_post_getiounit(V9fsState *s, V9fsCreateState *vs)
2266 {
2267 int err;
2268 v9fs_string_copy(&vs->fidp->path, &vs->fullname);
2269 stat_to_qid(&vs->stbuf, &vs->qid);
2270
2271 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, vs->iounit);
2272 err = vs->offset;
2273
2274 complete_pdu(s, vs->pdu, err);
2275 v9fs_string_free(&vs->name);
2276 v9fs_string_free(&vs->extension);
2277 v9fs_string_free(&vs->fullname);
2278 qemu_free(vs);
2279 }
2280
2281 static void v9fs_post_create(V9fsState *s, V9fsCreateState *vs, int err)
2282 {
2283 if (err == 0) {
2284 vs->iounit = get_iounit(s, &vs->fidp->path);
2285 v9fs_create_post_getiounit(s, vs);
2286 return;
2287 }
2288
2289 complete_pdu(s, vs->pdu, err);
2290 v9fs_string_free(&vs->name);
2291 v9fs_string_free(&vs->extension);
2292 v9fs_string_free(&vs->fullname);
2293 qemu_free(vs);
2294 }
2295
2296 static void v9fs_create_post_perms(V9fsState *s, V9fsCreateState *vs, int err)
2297 {
2298 if (err) {
2299 err = -errno;
2300 }
2301 v9fs_post_create(s, vs, err);
2302 }
2303
2304 static void v9fs_create_post_opendir(V9fsState *s, V9fsCreateState *vs,
2305 int err)
2306 {
2307 if (!vs->fidp->fs.dir) {
2308 err = -errno;
2309 }
2310 vs->fidp->fid_type = P9_FID_DIR;
2311 v9fs_post_create(s, vs, err);
2312 }
2313
2314 static void v9fs_create_post_dir_lstat(V9fsState *s, V9fsCreateState *vs,
2315 int err)
2316 {
2317 if (err) {
2318 err = -errno;
2319 goto out;
2320 }
2321
2322 vs->fidp->fs.dir = v9fs_do_opendir(s, &vs->fullname);
2323 v9fs_create_post_opendir(s, vs, err);
2324 return;
2325
2326 out:
2327 v9fs_post_create(s, vs, err);
2328 }
2329
2330 static void v9fs_create_post_mkdir(V9fsState *s, V9fsCreateState *vs, int err)
2331 {
2332 if (err) {
2333 err = -errno;
2334 goto out;
2335 }
2336
2337 err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2338 v9fs_create_post_dir_lstat(s, vs, err);
2339 return;
2340
2341 out:
2342 v9fs_post_create(s, vs, err);
2343 }
2344
2345 static void v9fs_create_post_fstat(V9fsState *s, V9fsCreateState *vs, int err)
2346 {
2347 if (err) {
2348 vs->fidp->fid_type = P9_FID_NONE;
2349 close(vs->fidp->fs.fd);
2350 err = -errno;
2351 }
2352 v9fs_post_create(s, vs, err);
2353 return;
2354 }
2355
2356 static void v9fs_create_post_open2(V9fsState *s, V9fsCreateState *vs, int err)
2357 {
2358 if (vs->fidp->fs.fd == -1) {
2359 err = -errno;
2360 goto out;
2361 }
2362 vs->fidp->fid_type = P9_FID_FILE;
2363 err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
2364 v9fs_create_post_fstat(s, vs, err);
2365
2366 return;
2367
2368 out:
2369 v9fs_post_create(s, vs, err);
2370
2371 }
2372
2373 static void v9fs_create_post_lstat(V9fsState *s, V9fsCreateState *vs, int err)
2374 {
2375
2376 if (err == 0 || errno != ENOENT) {
2377 err = -errno;
2378 goto out;
2379 }
2380
2381 if (vs->perm & P9_STAT_MODE_DIR) {
2382 err = v9fs_do_mkdir(s, vs->fullname.data, vs->perm & 0777,
2383 vs->fidp->uid, -1);
2384 v9fs_create_post_mkdir(s, vs, err);
2385 } else if (vs->perm & P9_STAT_MODE_SYMLINK) {
2386 err = v9fs_do_symlink(s, vs->fidp, vs->extension.data,
2387 vs->fullname.data, -1);
2388 v9fs_create_post_perms(s, vs, err);
2389 } else if (vs->perm & P9_STAT_MODE_LINK) {
2390 int32_t nfid = atoi(vs->extension.data);
2391 V9fsFidState *nfidp = lookup_fid(s, nfid);
2392 if (nfidp == NULL) {
2393 err = -errno;
2394 v9fs_post_create(s, vs, err);
2395 }
2396 err = v9fs_do_link(s, &nfidp->path, &vs->fullname);
2397 v9fs_create_post_perms(s, vs, err);
2398 } else if (vs->perm & P9_STAT_MODE_DEVICE) {
2399 char ctype;
2400 uint32_t major, minor;
2401 mode_t nmode = 0;
2402
2403 if (sscanf(vs->extension.data, "%c %u %u", &ctype, &major,
2404 &minor) != 3) {
2405 err = -errno;
2406 v9fs_post_create(s, vs, err);
2407 }
2408
2409 switch (ctype) {
2410 case 'c':
2411 nmode = S_IFCHR;
2412 break;
2413 case 'b':
2414 nmode = S_IFBLK;
2415 break;
2416 default:
2417 err = -EIO;
2418 v9fs_post_create(s, vs, err);
2419 }
2420
2421 nmode |= vs->perm & 0777;
2422 err = v9fs_do_mknod(s, vs->fullname.data, nmode,
2423 makedev(major, minor), vs->fidp->uid, -1);
2424 v9fs_create_post_perms(s, vs, err);
2425 } else if (vs->perm & P9_STAT_MODE_NAMED_PIPE) {
2426 err = v9fs_do_mknod(s, vs->fullname.data, S_IFIFO | (vs->perm & 0777),
2427 0, vs->fidp->uid, -1);
2428 v9fs_post_create(s, vs, err);
2429 } else if (vs->perm & P9_STAT_MODE_SOCKET) {
2430 err = v9fs_do_mknod(s, vs->fullname.data, S_IFSOCK | (vs->perm & 0777),
2431 0, vs->fidp->uid, -1);
2432 v9fs_post_create(s, vs, err);
2433 } else {
2434 vs->fidp->fs.fd = v9fs_do_open2(s, vs->fullname.data, vs->fidp->uid,
2435 -1, omode_to_uflags(vs->mode)|O_CREAT, vs->perm);
2436
2437 v9fs_create_post_open2(s, vs, err);
2438 }
2439
2440 return;
2441
2442 out:
2443 v9fs_post_create(s, vs, err);
2444 }
2445
2446 static void v9fs_create(void *opaque)
2447 {
2448 V9fsPDU *pdu = opaque;
2449 V9fsState *s = pdu->s;
2450 int32_t fid;
2451 V9fsCreateState *vs;
2452 int err = 0;
2453
2454 vs = qemu_malloc(sizeof(*vs));
2455 vs->pdu = pdu;
2456 vs->offset = 7;
2457
2458 v9fs_string_init(&vs->fullname);
2459
2460 pdu_unmarshal(vs->pdu, vs->offset, "dsdbs", &fid, &vs->name,
2461 &vs->perm, &vs->mode, &vs->extension);
2462
2463 vs->fidp = lookup_fid(s, fid);
2464 if (vs->fidp == NULL) {
2465 err = -EINVAL;
2466 goto out;
2467 }
2468
2469 v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->fidp->path.data,
2470 vs->name.data);
2471
2472 err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2473 v9fs_create_post_lstat(s, vs, err);
2474 return;
2475
2476 out:
2477 complete_pdu(s, vs->pdu, err);
2478 v9fs_string_free(&vs->name);
2479 v9fs_string_free(&vs->extension);
2480 qemu_free(vs);
2481 }
2482
2483 static void v9fs_post_symlink(V9fsState *s, V9fsSymlinkState *vs, int err)
2484 {
2485 if (err == 0) {
2486 stat_to_qid(&vs->stbuf, &vs->qid);
2487 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
2488 err = vs->offset;
2489 } else {
2490 err = -errno;
2491 }
2492 complete_pdu(s, vs->pdu, err);
2493 v9fs_string_free(&vs->name);
2494 v9fs_string_free(&vs->symname);
2495 v9fs_string_free(&vs->fullname);
2496 qemu_free(vs);
2497 }
2498
2499 static void v9fs_symlink_post_do_symlink(V9fsState *s, V9fsSymlinkState *vs,
2500 int err)
2501 {
2502 if (err) {
2503 goto out;
2504 }
2505 err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2506 out:
2507 v9fs_post_symlink(s, vs, err);
2508 }
2509
2510 static void v9fs_symlink(void *opaque)
2511 {
2512 V9fsPDU *pdu = opaque;
2513 V9fsState *s = pdu->s;
2514 int32_t dfid;
2515 V9fsSymlinkState *vs;
2516 int err = 0;
2517 gid_t gid;
2518
2519 vs = qemu_malloc(sizeof(*vs));
2520 vs->pdu = pdu;
2521 vs->offset = 7;
2522
2523 v9fs_string_init(&vs->fullname);
2524
2525 pdu_unmarshal(vs->pdu, vs->offset, "dssd", &dfid, &vs->name,
2526 &vs->symname, &gid);
2527
2528 vs->dfidp = lookup_fid(s, dfid);
2529 if (vs->dfidp == NULL) {
2530 err = -EINVAL;
2531 goto out;
2532 }
2533
2534 v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->dfidp->path.data,
2535 vs->name.data);
2536 err = v9fs_do_symlink(s, vs->dfidp, vs->symname.data,
2537 vs->fullname.data, gid);
2538 v9fs_symlink_post_do_symlink(s, vs, err);
2539 return;
2540
2541 out:
2542 complete_pdu(s, vs->pdu, err);
2543 v9fs_string_free(&vs->name);
2544 v9fs_string_free(&vs->symname);
2545 qemu_free(vs);
2546 }
2547
2548 static void v9fs_flush(void *opaque)
2549 {
2550 V9fsPDU *pdu = opaque;
2551 V9fsState *s = pdu->s;
2552 /* A nop call with no return */
2553 complete_pdu(s, pdu, 7);
2554 return;
2555 }
2556
2557 static void v9fs_link(void *opaque)
2558 {
2559 V9fsPDU *pdu = opaque;
2560 V9fsState *s = pdu->s;
2561 int32_t dfid, oldfid;
2562 V9fsFidState *dfidp, *oldfidp;
2563 V9fsString name, fullname;
2564 size_t offset = 7;
2565 int err = 0;
2566
2567 v9fs_string_init(&fullname);
2568
2569 pdu_unmarshal(pdu, offset, "dds", &dfid, &oldfid, &name);
2570
2571 dfidp = lookup_fid(s, dfid);
2572 if (dfidp == NULL) {
2573 err = -errno;
2574 goto out;
2575 }
2576
2577 oldfidp = lookup_fid(s, oldfid);
2578 if (oldfidp == NULL) {
2579 err = -errno;
2580 goto out;
2581 }
2582
2583 v9fs_string_sprintf(&fullname, "%s/%s", dfidp->path.data, name.data);
2584 err = offset;
2585 err = v9fs_do_link(s, &oldfidp->path, &fullname);
2586 if (err) {
2587 err = -errno;
2588 }
2589 v9fs_string_free(&fullname);
2590
2591 out:
2592 v9fs_string_free(&name);
2593 complete_pdu(s, pdu, err);
2594 }
2595
2596 static void v9fs_remove_post_remove(V9fsState *s, V9fsRemoveState *vs,
2597 int err)
2598 {
2599 if (err < 0) {
2600 err = -errno;
2601 } else {
2602 err = vs->offset;
2603 }
2604
2605 /* For TREMOVE we need to clunk the fid even on failed remove */
2606 free_fid(s, vs->fidp->fid);
2607
2608 complete_pdu(s, vs->pdu, err);
2609 qemu_free(vs);
2610 }
2611
2612 static void v9fs_remove(void *opaque)
2613 {
2614 V9fsPDU *pdu = opaque;
2615 V9fsState *s = pdu->s;
2616 int32_t fid;
2617 V9fsRemoveState *vs;
2618 int err = 0;
2619
2620 vs = qemu_malloc(sizeof(*vs));
2621 vs->pdu = pdu;
2622 vs->offset = 7;
2623
2624 pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
2625
2626 vs->fidp = lookup_fid(s, fid);
2627 if (vs->fidp == NULL) {
2628 err = -EINVAL;
2629 goto out;
2630 }
2631
2632 err = v9fs_do_remove(s, &vs->fidp->path);
2633 v9fs_remove_post_remove(s, vs, err);
2634 return;
2635
2636 out:
2637 complete_pdu(s, pdu, err);
2638 qemu_free(vs);
2639 }
2640
2641 static void v9fs_wstat_post_truncate(V9fsState *s, V9fsWstatState *vs, int err)
2642 {
2643 if (err < 0) {
2644 goto out;
2645 }
2646
2647 err = vs->offset;
2648
2649 out:
2650 v9fs_stat_free(&vs->v9stat);
2651 complete_pdu(s, vs->pdu, err);
2652 qemu_free(vs);
2653 }
2654
2655 static void v9fs_wstat_post_rename(V9fsState *s, V9fsWstatState *vs, int err)
2656 {
2657 if (err < 0) {
2658 goto out;
2659 }
2660 if (vs->v9stat.length != -1) {
2661 if (v9fs_do_truncate(s, &vs->fidp->path, vs->v9stat.length) < 0) {
2662 err = -errno;
2663 }
2664 }
2665 v9fs_wstat_post_truncate(s, vs, err);
2666 return;
2667
2668 out:
2669 v9fs_stat_free(&vs->v9stat);
2670 complete_pdu(s, vs->pdu, err);
2671 qemu_free(vs);
2672 }
2673
2674 static int v9fs_complete_rename(V9fsState *s, V9fsRenameState *vs)
2675 {
2676 int err = 0;
2677 char *old_name, *new_name;
2678 char *end;
2679
2680 if (vs->newdirfid != -1) {
2681 V9fsFidState *dirfidp;
2682 dirfidp = lookup_fid(s, vs->newdirfid);
2683
2684 if (dirfidp == NULL) {
2685 err = -ENOENT;
2686 goto out;
2687 }
2688
2689 BUG_ON(dirfidp->fid_type != P9_FID_NONE);
2690
2691 new_name = qemu_mallocz(dirfidp->path.size + vs->name.size + 2);
2692
2693 strcpy(new_name, dirfidp->path.data);
2694 strcat(new_name, "/");
2695 strcat(new_name + dirfidp->path.size, vs->name.data);
2696 } else {
2697 old_name = vs->fidp->path.data;
2698 end = strrchr(old_name, '/');
2699 if (end) {
2700 end++;
2701 } else {
2702 end = old_name;
2703 }
2704 new_name = qemu_mallocz(end - old_name + vs->name.size + 1);
2705
2706 strncat(new_name, old_name, end - old_name);
2707 strncat(new_name + (end - old_name), vs->name.data, vs->name.size);
2708 }
2709
2710 v9fs_string_free(&vs->name);
2711 vs->name.data = qemu_strdup(new_name);
2712 vs->name.size = strlen(new_name);
2713
2714 if (strcmp(new_name, vs->fidp->path.data) != 0) {
2715 if (v9fs_do_rename(s, &vs->fidp->path, &vs->name)) {
2716 err = -errno;
2717 } else {
2718 V9fsFidState *fidp;
2719 /*
2720 * Fixup fid's pointing to the old name to
2721 * start pointing to the new name
2722 */
2723 for (fidp = s->fid_list; fidp; fidp = fidp->next) {
2724 if (vs->fidp == fidp) {
2725 /*
2726 * we replace name of this fid towards the end so
2727 * that our below v9fs_path_is_ancestor check will
2728 * work
2729 */
2730 continue;
2731 }
2732 if (v9fs_path_is_ancestor(&vs->fidp->path, &fidp->path)) {
2733 /* replace the name */
2734 v9fs_fix_path(&fidp->path, &vs->name,
2735 strlen(vs->fidp->path.data));
2736 }
2737 }
2738 v9fs_string_copy(&vs->fidp->path, &vs->name);
2739 }
2740 }
2741 out:
2742 v9fs_string_free(&vs->name);
2743 return err;
2744 }
2745
2746 static void v9fs_rename_post_rename(V9fsState *s, V9fsRenameState *vs, int err)
2747 {
2748 complete_pdu(s, vs->pdu, err);
2749 qemu_free(vs);
2750 }
2751
2752 static void v9fs_wstat_post_chown(V9fsState *s, V9fsWstatState *vs, int err)
2753 {
2754 if (err < 0) {
2755 goto out;
2756 }
2757
2758 if (vs->v9stat.name.size != 0) {
2759 V9fsRenameState *vr;
2760
2761 vr = qemu_mallocz(sizeof(V9fsRenameState));
2762 vr->newdirfid = -1;
2763 vr->pdu = vs->pdu;
2764 vr->fidp = vs->fidp;
2765 vr->offset = vs->offset;
2766 vr->name.size = vs->v9stat.name.size;
2767 vr->name.data = qemu_strdup(vs->v9stat.name.data);
2768
2769 err = v9fs_complete_rename(s, vr);
2770 qemu_free(vr);
2771 }
2772 v9fs_wstat_post_rename(s, vs, err);
2773 return;
2774
2775 out:
2776 v9fs_stat_free(&vs->v9stat);
2777 complete_pdu(s, vs->pdu, err);
2778 qemu_free(vs);
2779 }
2780
2781 static void v9fs_rename(void *opaque)
2782 {
2783 V9fsPDU *pdu = opaque;
2784 V9fsState *s = pdu->s;
2785 int32_t fid;
2786 V9fsRenameState *vs;
2787 ssize_t err = 0;
2788
2789 vs = qemu_malloc(sizeof(*vs));
2790 vs->pdu = pdu;
2791 vs->offset = 7;
2792
2793 pdu_unmarshal(vs->pdu, vs->offset, "dds", &fid, &vs->newdirfid, &vs->name);
2794
2795 vs->fidp = lookup_fid(s, fid);
2796 if (vs->fidp == NULL) {
2797 err = -ENOENT;
2798 goto out;
2799 }
2800
2801 BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
2802
2803 err = v9fs_complete_rename(s, vs);
2804 v9fs_rename_post_rename(s, vs, err);
2805 return;
2806 out:
2807 complete_pdu(s, vs->pdu, err);
2808 qemu_free(vs);
2809 }
2810
2811 static void v9fs_wstat_post_utime(V9fsState *s, V9fsWstatState *vs, int err)
2812 {
2813 if (err < 0) {
2814 goto out;
2815 }
2816
2817 if (vs->v9stat.n_gid != -1 || vs->v9stat.n_uid != -1) {
2818 if (v9fs_do_chown(s, &vs->fidp->path, vs->v9stat.n_uid,
2819 vs->v9stat.n_gid)) {
2820 err = -errno;
2821 }
2822 }
2823 v9fs_wstat_post_chown(s, vs, err);
2824 return;
2825
2826 out:
2827 v9fs_stat_free(&vs->v9stat);
2828 complete_pdu(s, vs->pdu, err);
2829 qemu_free(vs);
2830 }
2831
2832 static void v9fs_wstat_post_chmod(V9fsState *s, V9fsWstatState *vs, int err)
2833 {
2834 if (err < 0) {
2835 goto out;
2836 }
2837
2838 if (vs->v9stat.mtime != -1 || vs->v9stat.atime != -1) {
2839 struct timespec times[2];
2840 if (vs->v9stat.atime != -1) {
2841 times[0].tv_sec = vs->v9stat.atime;
2842 times[0].tv_nsec = 0;
2843 } else {
2844 times[0].tv_nsec = UTIME_OMIT;
2845 }
2846 if (vs->v9stat.mtime != -1) {
2847 times[1].tv_sec = vs->v9stat.mtime;
2848 times[1].tv_nsec = 0;
2849 } else {
2850 times[1].tv_nsec = UTIME_OMIT;
2851 }
2852
2853 if (v9fs_do_utimensat(s, &vs->fidp->path, times)) {
2854 err = -errno;
2855 }
2856 }
2857
2858 v9fs_wstat_post_utime(s, vs, err);
2859 return;
2860
2861 out:
2862 v9fs_stat_free(&vs->v9stat);
2863 complete_pdu(s, vs->pdu, err);
2864 qemu_free(vs);
2865 }
2866
2867 static void v9fs_wstat_post_fsync(V9fsState *s, V9fsWstatState *vs, int err)
2868 {
2869 if (err == -1) {
2870 err = -errno;
2871 }
2872 v9fs_stat_free(&vs->v9stat);
2873 complete_pdu(s, vs->pdu, err);
2874 qemu_free(vs);
2875 }
2876
2877 static void v9fs_wstat_post_lstat(V9fsState *s, V9fsWstatState *vs, int err)
2878 {
2879 uint32_t v9_mode;
2880
2881 if (err == -1) {
2882 err = -errno;
2883 goto out;
2884 }
2885
2886 v9_mode = stat_to_v9mode(&vs->stbuf);
2887
2888 if ((vs->v9stat.mode & P9_STAT_MODE_TYPE_BITS) !=
2889 (v9_mode & P9_STAT_MODE_TYPE_BITS)) {
2890 /* Attempting to change the type */
2891 err = -EIO;
2892 goto out;
2893 }
2894
2895 if (v9fs_do_chmod(s, &vs->fidp->path, v9mode_to_mode(vs->v9stat.mode,
2896 &vs->v9stat.extension))) {
2897 err = -errno;
2898 }
2899 v9fs_wstat_post_chmod(s, vs, err);
2900 return;
2901
2902 out:
2903 v9fs_stat_free(&vs->v9stat);
2904 complete_pdu(s, vs->pdu, err);
2905 qemu_free(vs);
2906 }
2907
2908 static void v9fs_wstat(void *opaque)
2909 {
2910 V9fsPDU *pdu = opaque;
2911 V9fsState *s = pdu->s;
2912 int32_t fid;
2913 V9fsWstatState *vs;
2914 int err = 0;
2915
2916 vs = qemu_malloc(sizeof(*vs));
2917 vs->pdu = pdu;
2918 vs->offset = 7;
2919
2920 pdu_unmarshal(pdu, vs->offset, "dwS", &fid, &vs->unused, &vs->v9stat);
2921
2922 vs->fidp = lookup_fid(s, fid);
2923 if (vs->fidp == NULL) {
2924 err = -EINVAL;
2925 goto out;
2926 }
2927
2928 /* do we need to sync the file? */
2929 if (donttouch_stat(&vs->v9stat)) {
2930 err = v9fs_do_fsync(s, vs->fidp->fs.fd, 0);
2931 v9fs_wstat_post_fsync(s, vs, err);
2932 return;
2933 }
2934
2935 if (vs->v9stat.mode != -1) {
2936 err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
2937 v9fs_wstat_post_lstat(s, vs, err);
2938 return;
2939 }
2940
2941 v9fs_wstat_post_chmod(s, vs, err);
2942 return;
2943
2944 out:
2945 v9fs_stat_free(&vs->v9stat);
2946 complete_pdu(s, vs->pdu, err);
2947 qemu_free(vs);
2948 }
2949
2950 static int v9fs_fill_statfs(V9fsState *s, V9fsPDU *pdu, struct statfs *stbuf)
2951 {
2952 uint32_t f_type;
2953 uint32_t f_bsize;
2954 uint64_t f_blocks;
2955 uint64_t f_bfree;
2956 uint64_t f_bavail;
2957 uint64_t f_files;
2958 uint64_t f_ffree;
2959 uint64_t fsid_val;
2960 uint32_t f_namelen;
2961 size_t offset = 7;
2962 int32_t bsize_factor;
2963
2964 /*
2965 * compute bsize factor based on host file system block size
2966 * and client msize
2967 */
2968 bsize_factor = (s->msize - P9_IOHDRSZ)/stbuf->f_bsize;
2969 if (!bsize_factor) {
2970 bsize_factor = 1;
2971 }
2972 f_type = stbuf->f_type;
2973 f_bsize = stbuf->f_bsize;
2974 f_bsize *= bsize_factor;
2975 /*
2976 * f_bsize is adjusted(multiplied) by bsize factor, so we need to
2977 * adjust(divide) the number of blocks, free blocks and available
2978 * blocks by bsize factor
2979 */
2980 f_blocks = stbuf->f_blocks/bsize_factor;
2981 f_bfree = stbuf->f_bfree/bsize_factor;
2982 f_bavail = stbuf->f_bavail/bsize_factor;
2983 f_files = stbuf->f_files;
2984 f_ffree = stbuf->f_ffree;
2985 fsid_val = (unsigned int) stbuf->f_fsid.__val[0] |
2986 (unsigned long long)stbuf->f_fsid.__val[1] << 32;
2987 f_namelen = stbuf->f_namelen;
2988
2989 return pdu_marshal(pdu, offset, "ddqqqqqqd",
2990 f_type, f_bsize, f_blocks, f_bfree,
2991 f_bavail, f_files, f_ffree,
2992 fsid_val, f_namelen);
2993 }
2994
2995 static void v9fs_statfs(void *opaque)
2996 {
2997 int32_t fid;
2998 ssize_t retval = 0;
2999 size_t offset = 7;
3000 V9fsFidState *fidp;
3001 struct statfs stbuf;
3002 V9fsPDU *pdu = opaque;
3003 V9fsState *s = pdu->s;
3004
3005 pdu_unmarshal(pdu, offset, "d", &fid);
3006 fidp = lookup_fid(s, fid);
3007 if (fidp == NULL) {
3008 retval = -ENOENT;
3009 goto out;
3010 }
3011 retval = v9fs_co_statfs(s, &fidp->path, &stbuf);
3012 if (retval < 0) {
3013 goto out;
3014 }
3015 retval = offset;
3016 retval += v9fs_fill_statfs(s, pdu, &stbuf);
3017 out:
3018 complete_pdu(s, pdu, retval);
3019 return;
3020 }
3021
3022 static void v9fs_mknod_post_lstat(V9fsState *s, V9fsMkState *vs, int err)
3023 {
3024 if (err == -1) {
3025 err = -errno;
3026 goto out;
3027 }
3028
3029 stat_to_qid(&vs->stbuf, &vs->qid);
3030 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
3031 err = vs->offset;
3032 out:
3033 complete_pdu(s, vs->pdu, err);
3034 v9fs_string_free(&vs->fullname);
3035 v9fs_string_free(&vs->name);
3036 qemu_free(vs);
3037 }
3038
3039 static void v9fs_mknod_post_mknod(V9fsState *s, V9fsMkState *vs, int err)
3040 {
3041 if (err == -1) {
3042 err = -errno;
3043 goto out;
3044 }
3045
3046 err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
3047 v9fs_mknod_post_lstat(s, vs, err);
3048 return;
3049 out:
3050 complete_pdu(s, vs->pdu, err);
3051 v9fs_string_free(&vs->fullname);
3052 v9fs_string_free(&vs->name);
3053 qemu_free(vs);
3054 }
3055
3056 static void v9fs_mknod(void *opaque)
3057 {
3058 V9fsPDU *pdu = opaque;
3059 V9fsState *s = pdu->s;
3060 int32_t fid;
3061 V9fsMkState *vs;
3062 int err = 0;
3063 V9fsFidState *fidp;
3064 gid_t gid;
3065 int mode;
3066 int major, minor;
3067
3068 vs = qemu_malloc(sizeof(*vs));
3069 vs->pdu = pdu;
3070 vs->offset = 7;
3071
3072 v9fs_string_init(&vs->fullname);
3073 pdu_unmarshal(vs->pdu, vs->offset, "dsdddd", &fid, &vs->name, &mode,
3074 &major, &minor, &gid);
3075
3076 fidp = lookup_fid(s, fid);
3077 if (fidp == NULL) {
3078 err = -ENOENT;
3079 goto out;
3080 }
3081
3082 v9fs_string_sprintf(&vs->fullname, "%s/%s", fidp->path.data, vs->name.data);
3083 err = v9fs_do_mknod(s, vs->fullname.data, mode, makedev(major, minor),
3084 fidp->uid, gid);
3085 v9fs_mknod_post_mknod(s, vs, err);
3086 return;
3087
3088 out:
3089 complete_pdu(s, vs->pdu, err);
3090 v9fs_string_free(&vs->fullname);
3091 v9fs_string_free(&vs->name);
3092 qemu_free(vs);
3093 }
3094
3095 /*
3096 * Implement posix byte range locking code
3097 * Server side handling of locking code is very simple, because 9p server in
3098 * QEMU can handle only one client. And most of the lock handling
3099 * (like conflict, merging) etc is done by the VFS layer itself, so no need to
3100 * do any thing in * qemu 9p server side lock code path.
3101 * So when a TLOCK request comes, always return success
3102 */
3103
3104 static void v9fs_lock(void *opaque)
3105 {
3106 V9fsPDU *pdu = opaque;
3107 V9fsState *s = pdu->s;
3108 int32_t fid, err = 0;
3109 V9fsLockState *vs;
3110
3111 vs = qemu_mallocz(sizeof(*vs));
3112 vs->pdu = pdu;
3113 vs->offset = 7;
3114
3115 vs->flock = qemu_malloc(sizeof(*vs->flock));
3116 pdu_unmarshal(vs->pdu, vs->offset, "dbdqqds", &fid, &vs->flock->type,
3117 &vs->flock->flags, &vs->flock->start, &vs->flock->length,
3118 &vs->flock->proc_id, &vs->flock->client_id);
3119
3120 vs->status = P9_LOCK_ERROR;
3121
3122 /* We support only block flag now (that too ignored currently) */
3123 if (vs->flock->flags & ~P9_LOCK_FLAGS_BLOCK) {
3124 err = -EINVAL;
3125 goto out;
3126 }
3127 vs->fidp = lookup_fid(s, fid);
3128 if (vs->fidp == NULL) {
3129 err = -ENOENT;
3130 goto out;
3131 }
3132
3133 err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
3134 if (err < 0) {
3135 err = -errno;
3136 goto out;
3137 }
3138 vs->status = P9_LOCK_SUCCESS;
3139 out:
3140 vs->offset += pdu_marshal(vs->pdu, vs->offset, "b", vs->status);
3141 complete_pdu(s, vs->pdu, err);
3142 qemu_free(vs->flock);
3143 qemu_free(vs);
3144 }
3145
3146 /*
3147 * When a TGETLOCK request comes, always return success because all lock
3148 * handling is done by client's VFS layer.
3149 */
3150
3151 static void v9fs_getlock(void *opaque)
3152 {
3153 V9fsPDU *pdu = opaque;
3154 V9fsState *s = pdu->s;
3155 int32_t fid, err = 0;
3156 V9fsGetlockState *vs;
3157
3158 vs = qemu_mallocz(sizeof(*vs));
3159 vs->pdu = pdu;
3160 vs->offset = 7;
3161
3162 vs->glock = qemu_malloc(sizeof(*vs->glock));
3163 pdu_unmarshal(vs->pdu, vs->offset, "dbqqds", &fid, &vs->glock->type,
3164 &vs->glock->start, &vs->glock->length, &vs->glock->proc_id,
3165 &vs->glock->client_id);
3166
3167 vs->fidp = lookup_fid(s, fid);
3168 if (vs->fidp == NULL) {
3169 err = -ENOENT;
3170 goto out;
3171 }
3172
3173 err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
3174 if (err < 0) {
3175 err = -errno;
3176 goto out;
3177 }
3178 vs->glock->type = F_UNLCK;
3179 vs->offset += pdu_marshal(vs->pdu, vs->offset, "bqqds", vs->glock->type,
3180 vs->glock->start, vs->glock->length, vs->glock->proc_id,
3181 &vs->glock->client_id);
3182 out:
3183 complete_pdu(s, vs->pdu, err);
3184 qemu_free(vs->glock);
3185 qemu_free(vs);
3186 }
3187
3188 static void v9fs_mkdir_post_lstat(V9fsState *s, V9fsMkState *vs, int err)
3189 {
3190 if (err == -1) {
3191 err = -errno;
3192 goto out;
3193 }
3194
3195 stat_to_qid(&vs->stbuf, &vs->qid);
3196 vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
3197 err = vs->offset;
3198 out:
3199 complete_pdu(s, vs->pdu, err);
3200 v9fs_string_free(&vs->fullname);
3201 v9fs_string_free(&vs->name);
3202 qemu_free(vs);
3203 }
3204
3205 static void v9fs_mkdir_post_mkdir(V9fsState *s, V9fsMkState *vs, int err)
3206 {
3207 if (err == -1) {
3208 err = -errno;
3209 goto out;
3210 }
3211
3212 err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
3213 v9fs_mkdir_post_lstat(s, vs, err);
3214 return;
3215 out:
3216 complete_pdu(s, vs->pdu, err);
3217 v9fs_string_free(&vs->fullname);
3218 v9fs_string_free(&vs->name);
3219 qemu_free(vs);
3220 }
3221
3222 static void v9fs_mkdir(void *opaque)
3223 {
3224 V9fsPDU *pdu = opaque;
3225 V9fsState *s = pdu->s;
3226 int32_t fid;
3227 V9fsMkState *vs;
3228 int err = 0;
3229 V9fsFidState *fidp;
3230 gid_t gid;
3231 int mode;
3232
3233 vs = qemu_malloc(sizeof(*vs));
3234 vs->pdu = pdu;
3235 vs->offset = 7;
3236
3237 v9fs_string_init(&vs->fullname);
3238 pdu_unmarshal(vs->pdu, vs->offset, "dsdd", &fid, &vs->name, &mode,
3239 &gid);
3240
3241 fidp = lookup_fid(s, fid);
3242 if (fidp == NULL) {
3243 err = -ENOENT;
3244 goto out;
3245 }
3246
3247 v9fs_string_sprintf(&vs->fullname, "%s/%s", fidp->path.data, vs->name.data);
3248 err = v9fs_do_mkdir(s, vs->fullname.data, mode, fidp->uid, gid);
3249 v9fs_mkdir_post_mkdir(s, vs, err);
3250 return;
3251
3252 out:
3253 complete_pdu(s, vs->pdu, err);
3254 v9fs_string_free(&vs->fullname);
3255 v9fs_string_free(&vs->name);
3256 qemu_free(vs);
3257 }
3258
3259 static void v9fs_xattrwalk(void *opaque)
3260 {
3261 int64_t size;
3262 V9fsString name;
3263 ssize_t err = 0;
3264 size_t offset = 7;
3265 int32_t fid, newfid;
3266 V9fsFidState *file_fidp;
3267 V9fsFidState *xattr_fidp;
3268 V9fsPDU *pdu = opaque;
3269 V9fsState *s = pdu->s;
3270
3271 pdu_unmarshal(pdu, offset, "dds", &fid, &newfid, &name);
3272 file_fidp = lookup_fid(s, fid);
3273 if (file_fidp == NULL) {
3274 err = -ENOENT;
3275 goto out;
3276 }
3277 xattr_fidp = alloc_fid(s, newfid);
3278 if (xattr_fidp == NULL) {
3279 err = -EINVAL;
3280 goto out;
3281 }
3282 v9fs_string_copy(&xattr_fidp->path, &file_fidp->path);
3283 if (name.data[0] == 0) {
3284 /*
3285 * listxattr request. Get the size first
3286 */
3287 size = v9fs_co_llistxattr(s, &xattr_fidp->path, NULL, 0);
3288 if (size < 0) {
3289 err = size;
3290 free_fid(s, xattr_fidp->fid);
3291 goto out;
3292 }
3293 /*
3294 * Read the xattr value
3295 */
3296 xattr_fidp->fs.xattr.len = size;
3297 xattr_fidp->fid_type = P9_FID_XATTR;
3298 xattr_fidp->fs.xattr.copied_len = -1;
3299 if (size) {
3300 xattr_fidp->fs.xattr.value = qemu_malloc(size);
3301 err = v9fs_co_llistxattr(s, &xattr_fidp->path,
3302 xattr_fidp->fs.xattr.value,
3303 xattr_fidp->fs.xattr.len);
3304 if (err < 0) {
3305 free_fid(s, xattr_fidp->fid);
3306 goto out;
3307 }
3308 }
3309 offset += pdu_marshal(pdu, offset, "q", size);
3310 err = offset;
3311 } else {
3312 /*
3313 * specific xattr fid. We check for xattr
3314 * presence also collect the xattr size
3315 */
3316 size = v9fs_co_lgetxattr(s, &xattr_fidp->path,
3317 &name, NULL, 0);
3318 if (size < 0) {
3319 err = size;
3320 free_fid(s, xattr_fidp->fid);
3321 goto out;
3322 }
3323 /*
3324 * Read the xattr value
3325 */
3326 xattr_fidp->fs.xattr.len = size;
3327 xattr_fidp->fid_type = P9_FID_XATTR;
3328 xattr_fidp->fs.xattr.copied_len = -1;
3329 if (size) {
3330 xattr_fidp->fs.xattr.value = qemu_malloc(size);
3331 err = v9fs_co_lgetxattr(s, &xattr_fidp->path,
3332 &name, xattr_fidp->fs.xattr.value,
3333 xattr_fidp->fs.xattr.len);
3334 if (err < 0) {
3335 free_fid(s, xattr_fidp->fid);
3336 goto out;
3337 }
3338 }
3339 offset += pdu_marshal(pdu, offset, "q", size);
3340 err = offset;
3341 }
3342 out:
3343 complete_pdu(s, pdu, err);
3344 v9fs_string_free(&name);
3345 }
3346
3347 static void v9fs_xattrcreate(void *opaque)
3348 {
3349 int flags;
3350 int32_t fid;
3351 int64_t size;
3352 ssize_t err = 0;
3353 V9fsString name;
3354 size_t offset = 7;
3355 V9fsFidState *file_fidp;
3356 V9fsFidState *xattr_fidp;
3357 V9fsPDU *pdu = opaque;
3358 V9fsState *s = pdu->s;
3359
3360 pdu_unmarshal(pdu, offset, "dsqd",
3361 &fid, &name, &size, &flags);
3362
3363 file_fidp = lookup_fid(s, fid);
3364 if (file_fidp == NULL) {
3365 err = -EINVAL;
3366 goto out;
3367 }
3368 /* Make the file fid point to xattr */
3369 xattr_fidp = file_fidp;
3370 xattr_fidp->fid_type = P9_FID_XATTR;
3371 xattr_fidp->fs.xattr.copied_len = 0;
3372 xattr_fidp->fs.xattr.len = size;
3373 xattr_fidp->fs.xattr.flags = flags;
3374 v9fs_string_init(&xattr_fidp->fs.xattr.name);
3375 v9fs_string_copy(&xattr_fidp->fs.xattr.name, &name);
3376 if (size) {
3377 xattr_fidp->fs.xattr.value = qemu_malloc(size);
3378 } else {
3379 xattr_fidp->fs.xattr.value = NULL;
3380 }
3381 err = offset;
3382 out:
3383 complete_pdu(s, pdu, err);
3384 v9fs_string_free(&name);
3385 }
3386
3387 static void v9fs_readlink(void *opaque)
3388 {
3389 V9fsPDU *pdu = opaque;
3390 size_t offset = 7;
3391 V9fsString target;
3392 int32_t fid;
3393 int err = 0;
3394 V9fsFidState *fidp;
3395
3396 pdu_unmarshal(pdu, offset, "d", &fid);
3397 fidp = lookup_fid(pdu->s, fid);
3398 if (fidp == NULL) {
3399 err = -ENOENT;
3400 goto out;
3401 }
3402
3403 v9fs_string_init(&target);
3404 err = v9fs_co_readlink(pdu->s, &fidp->path, &target);
3405 if (err < 0) {
3406 goto out;
3407 }
3408 offset += pdu_marshal(pdu, offset, "s", &target);
3409 err = offset;
3410 v9fs_string_free(&target);
3411 out:
3412 complete_pdu(pdu->s, pdu, err);
3413 }
3414
3415 static CoroutineEntry *pdu_co_handlers[] = {
3416 [P9_TREADDIR] = v9fs_readdir,
3417 [P9_TSTATFS] = v9fs_statfs,
3418 [P9_TGETATTR] = v9fs_getattr,
3419 [P9_TSETATTR] = v9fs_setattr,
3420 [P9_TXATTRWALK] = v9fs_xattrwalk,
3421 [P9_TXATTRCREATE] = v9fs_xattrcreate,
3422 [P9_TMKNOD] = v9fs_mknod,
3423 [P9_TRENAME] = v9fs_rename,
3424 [P9_TLOCK] = v9fs_lock,
3425 [P9_TGETLOCK] = v9fs_getlock,
3426 [P9_TREADLINK] = v9fs_readlink,
3427 [P9_TMKDIR] = v9fs_mkdir,
3428 [P9_TVERSION] = v9fs_version,
3429 [P9_TLOPEN] = v9fs_open,
3430 [P9_TATTACH] = v9fs_attach,
3431 [P9_TSTAT] = v9fs_stat,
3432 [P9_TWALK] = v9fs_walk,
3433 [P9_TCLUNK] = v9fs_clunk,
3434 [P9_TFSYNC] = v9fs_fsync,
3435 [P9_TOPEN] = v9fs_open,
3436 [P9_TREAD] = v9fs_read,
3437 #if 0
3438 [P9_TAUTH] = v9fs_auth,
3439 #endif
3440 [P9_TFLUSH] = v9fs_flush,
3441 [P9_TLINK] = v9fs_link,
3442 [P9_TSYMLINK] = v9fs_symlink,
3443 [P9_TCREATE] = v9fs_create,
3444 [P9_TLCREATE] = v9fs_lcreate,
3445 [P9_TWRITE] = v9fs_write,
3446 [P9_TWSTAT] = v9fs_wstat,
3447 [P9_TREMOVE] = v9fs_remove,
3448 };
3449
3450 static void v9fs_op_not_supp(void *opaque)
3451 {
3452 V9fsPDU *pdu = opaque;
3453 complete_pdu(pdu->s, pdu, -EOPNOTSUPP);
3454 }
3455
3456 static void submit_pdu(V9fsState *s, V9fsPDU *pdu)
3457 {
3458 Coroutine *co;
3459 CoroutineEntry *handler;
3460
3461 if (debug_9p_pdu) {
3462 pprint_pdu(pdu);
3463 }
3464 if (pdu->id >= ARRAY_SIZE(pdu_co_handlers) ||
3465 (pdu_co_handlers[pdu->id] == NULL)) {
3466 handler = v9fs_op_not_supp;
3467 } else {
3468 handler = pdu_co_handlers[pdu->id];
3469 }
3470 co = qemu_coroutine_create(handler);
3471 qemu_coroutine_enter(co, pdu);
3472 }
3473
3474 void handle_9p_output(VirtIODevice *vdev, VirtQueue *vq)
3475 {
3476 V9fsState *s = (V9fsState *)vdev;
3477 V9fsPDU *pdu;
3478 ssize_t len;
3479
3480 while ((pdu = alloc_pdu(s)) &&
3481 (len = virtqueue_pop(vq, &pdu->elem)) != 0) {
3482 uint8_t *ptr;
3483 pdu->s = s;
3484 BUG_ON(pdu->elem.out_num == 0 || pdu->elem.in_num == 0);
3485 BUG_ON(pdu->elem.out_sg[0].iov_len < 7);
3486
3487 ptr = pdu->elem.out_sg[0].iov_base;
3488
3489 memcpy(&pdu->size, ptr, 4);
3490 pdu->id = ptr[4];
3491 memcpy(&pdu->tag, ptr + 5, 2);
3492 submit_pdu(s, pdu);
3493 }
3494 free_pdu(s, pdu);
3495 }