Statistics
| Branch: | Revision:

root / hw / virtio-9p.c @ 45b23ff8

History | View | Annotate | Download (93.9 kB)

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 "virtio.h"
15
#include "pc.h"
16
#include "qemu_socket.h"
17
#include "virtio-9p.h"
18
#include "fsdev/qemu-fsdev.h"
19
#include "virtio-9p-debug.h"
20
#include "virtio-9p-xattr.h"
21

    
22
int debug_9p_pdu;
23

    
24
enum {
25
    Oread   = 0x00,
26
    Owrite  = 0x01,
27
    Ordwr   = 0x02,
28
    Oexec   = 0x03,
29
    Oexcl   = 0x04,
30
    Otrunc  = 0x10,
31
    Orexec  = 0x20,
32
    Orclose = 0x40,
33
    Oappend = 0x80,
34
};
35

    
36
static int omode_to_uflags(int8_t mode)
37
{
38
    int ret = 0;
39

    
40
    switch (mode & 3) {
41
    case Oread:
42
        ret = O_RDONLY;
43
        break;
44
    case Ordwr:
45
        ret = O_RDWR;
46
        break;
47
    case Owrite:
48
        ret = O_WRONLY;
49
        break;
50
    case Oexec:
51
        ret = O_RDONLY;
52
        break;
53
    }
54

    
55
    if (mode & Otrunc) {
56
        ret |= O_TRUNC;
57
    }
58

    
59
    if (mode & Oappend) {
60
        ret |= O_APPEND;
61
    }
62

    
63
    if (mode & Oexcl) {
64
        ret |= O_EXCL;
65
    }
66

    
67
    return ret;
68
}
69

    
70
void cred_init(FsCred *credp)
71
{
72
    credp->fc_uid = -1;
73
    credp->fc_gid = -1;
74
    credp->fc_mode = -1;
75
    credp->fc_rdev = -1;
76
}
77

    
78
static int v9fs_do_lstat(V9fsState *s, V9fsString *path, struct stat *stbuf)
79
{
80
    return s->ops->lstat(&s->ctx, path->data, stbuf);
81
}
82

    
83
static ssize_t v9fs_do_readlink(V9fsState *s, V9fsString *path, V9fsString *buf)
84
{
85
    ssize_t len;
86

    
87
    buf->data = qemu_malloc(1024);
88

    
89
    len = s->ops->readlink(&s->ctx, path->data, buf->data, 1024 - 1);
90
    if (len > -1) {
91
        buf->size = len;
92
        buf->data[len] = 0;
93
    }
94

    
95
    return len;
96
}
97

    
98
static int v9fs_do_close(V9fsState *s, int fd)
99
{
100
    return s->ops->close(&s->ctx, fd);
101
}
102

    
103
static int v9fs_do_closedir(V9fsState *s, DIR *dir)
104
{
105
    return s->ops->closedir(&s->ctx, dir);
106
}
107

    
108
static int v9fs_do_open(V9fsState *s, V9fsString *path, int flags)
109
{
110
    return s->ops->open(&s->ctx, path->data, flags);
111
}
112

    
113
static DIR *v9fs_do_opendir(V9fsState *s, V9fsString *path)
114
{
115
    return s->ops->opendir(&s->ctx, path->data);
116
}
117

    
118
static void v9fs_do_rewinddir(V9fsState *s, DIR *dir)
119
{
120
    return s->ops->rewinddir(&s->ctx, dir);
121
}
122

    
123
static off_t v9fs_do_telldir(V9fsState *s, DIR *dir)
124
{
125
    return s->ops->telldir(&s->ctx, dir);
126
}
127

    
128
static struct dirent *v9fs_do_readdir(V9fsState *s, DIR *dir)
129
{
130
    return s->ops->readdir(&s->ctx, dir);
131
}
132

    
133
static void v9fs_do_seekdir(V9fsState *s, DIR *dir, off_t off)
134
{
135
    return s->ops->seekdir(&s->ctx, dir, off);
136
}
137

    
138
static int v9fs_do_preadv(V9fsState *s, int fd, const struct iovec *iov,
139
                            int iovcnt, int64_t offset)
140
{
141
    return s->ops->preadv(&s->ctx, fd, iov, iovcnt, offset);
142
}
143

    
144
static int v9fs_do_pwritev(V9fsState *s, int fd, const struct iovec *iov,
145
                       int iovcnt, int64_t offset)
146
{
147
    return s->ops->pwritev(&s->ctx, fd, iov, iovcnt, offset);
148
}
149

    
150
static int v9fs_do_chmod(V9fsState *s, V9fsString *path, mode_t mode)
151
{
152
    FsCred cred;
153
    cred_init(&cred);
154
    cred.fc_mode = mode;
155
    return s->ops->chmod(&s->ctx, path->data, &cred);
156
}
157

    
158
static int v9fs_do_mknod(V9fsState *s, char *name,
159
        mode_t mode, dev_t dev, uid_t uid, gid_t gid)
160
{
161
    FsCred cred;
162
    cred_init(&cred);
163
    cred.fc_uid = uid;
164
    cred.fc_gid = gid;
165
    cred.fc_mode = mode;
166
    cred.fc_rdev = dev;
167
    return s->ops->mknod(&s->ctx, name, &cred);
168
}
169

    
170
static int v9fs_do_mkdir(V9fsState *s, char *name, mode_t mode,
171
                uid_t uid, gid_t gid)
172
{
173
    FsCred cred;
174

    
175
    cred_init(&cred);
176
    cred.fc_uid = uid;
177
    cred.fc_gid = gid;
178
    cred.fc_mode = mode;
179

    
180
    return s->ops->mkdir(&s->ctx, name, &cred);
181
}
182

    
183
static int v9fs_do_fstat(V9fsState *s, int fd, struct stat *stbuf)
184
{
185
    return s->ops->fstat(&s->ctx, fd, stbuf);
186
}
187

    
188
static int v9fs_do_open2(V9fsState *s, char *fullname, uid_t uid, gid_t gid,
189
        int flags, int mode)
190
{
191
    FsCred cred;
192

    
193
    cred_init(&cred);
194
    cred.fc_uid = uid;
195
    cred.fc_gid = gid;
196
    cred.fc_mode = mode & 07777;
197
    flags = flags;
198

    
199
    return s->ops->open2(&s->ctx, fullname, flags, &cred);
200
}
201

    
202
static int v9fs_do_symlink(V9fsState *s, V9fsFidState *fidp,
203
        const char *oldpath, const char *newpath, gid_t gid)
204
{
205
    FsCred cred;
206
    cred_init(&cred);
207
    cred.fc_uid = fidp->uid;
208
    cred.fc_gid = gid;
209
    cred.fc_mode = 0777;
210

    
211
    return s->ops->symlink(&s->ctx, oldpath, newpath, &cred);
212
}
213

    
214
static int v9fs_do_link(V9fsState *s, V9fsString *oldpath, V9fsString *newpath)
215
{
216
    return s->ops->link(&s->ctx, oldpath->data, newpath->data);
217
}
218

    
219
static int v9fs_do_truncate(V9fsState *s, V9fsString *path, off_t size)
220
{
221
    return s->ops->truncate(&s->ctx, path->data, size);
222
}
223

    
224
static int v9fs_do_rename(V9fsState *s, V9fsString *oldpath,
225
                            V9fsString *newpath)
226
{
227
    return s->ops->rename(&s->ctx, oldpath->data, newpath->data);
228
}
229

    
230
static int v9fs_do_chown(V9fsState *s, V9fsString *path, uid_t uid, gid_t gid)
231
{
232
    FsCred cred;
233
    cred_init(&cred);
234
    cred.fc_uid = uid;
235
    cred.fc_gid = gid;
236

    
237
    return s->ops->chown(&s->ctx, path->data, &cred);
238
}
239

    
240
static int v9fs_do_utimensat(V9fsState *s, V9fsString *path,
241
                                           const struct timespec times[2])
242
{
243
    return s->ops->utimensat(&s->ctx, path->data, times);
244
}
245

    
246
static int v9fs_do_remove(V9fsState *s, V9fsString *path)
247
{
248
    return s->ops->remove(&s->ctx, path->data);
249
}
250

    
251
static int v9fs_do_fsync(V9fsState *s, int fd)
252
{
253
    return s->ops->fsync(&s->ctx, fd);
254
}
255

    
256
static int v9fs_do_statfs(V9fsState *s, V9fsString *path, struct statfs *stbuf)
257
{
258
    return s->ops->statfs(&s->ctx, path->data, stbuf);
259
}
260

    
261
static ssize_t v9fs_do_lgetxattr(V9fsState *s, V9fsString *path,
262
                             V9fsString *xattr_name,
263
                             void *value, size_t size)
264
{
265
    return s->ops->lgetxattr(&s->ctx, path->data,
266
                             xattr_name->data, value, size);
267
}
268

    
269
static ssize_t v9fs_do_llistxattr(V9fsState *s, V9fsString *path,
270
                              void *value, size_t size)
271
{
272
    return s->ops->llistxattr(&s->ctx, path->data,
273
                              value, size);
274
}
275

    
276
static int v9fs_do_lsetxattr(V9fsState *s, V9fsString *path,
277
                             V9fsString *xattr_name,
278
                             void *value, size_t size, int flags)
279
{
280
    return s->ops->lsetxattr(&s->ctx, path->data,
281
                             xattr_name->data, value, size, flags);
282
}
283

    
284
static int v9fs_do_lremovexattr(V9fsState *s, V9fsString *path,
285
                                V9fsString *xattr_name)
286
{
287
    return s->ops->lremovexattr(&s->ctx, path->data,
288
                                xattr_name->data);
289
}
290

    
291

    
292
static void v9fs_string_init(V9fsString *str)
293
{
294
    str->data = NULL;
295
    str->size = 0;
296
}
297

    
298
static void v9fs_string_free(V9fsString *str)
299
{
300
    qemu_free(str->data);
301
    str->data = NULL;
302
    str->size = 0;
303
}
304

    
305
static void v9fs_string_null(V9fsString *str)
306
{
307
    v9fs_string_free(str);
308
}
309

    
310
static int number_to_string(void *arg, char type)
311
{
312
    unsigned int ret = 0;
313

    
314
    switch (type) {
315
    case 'u': {
316
        unsigned int num = *(unsigned int *)arg;
317

    
318
        do {
319
            ret++;
320
            num = num/10;
321
        } while (num);
322
        break;
323
    }
324
    case 'U': {
325
        unsigned long num = *(unsigned long *)arg;
326
        do {
327
            ret++;
328
            num = num/10;
329
        } while (num);
330
        break;
331
    }
332
    default:
333
        printf("Number_to_string: Unknown number format\n");
334
        return -1;
335
    }
336

    
337
    return ret;
338
}
339

    
340
static int GCC_FMT_ATTR(2, 0)
341
v9fs_string_alloc_printf(char **strp, const char *fmt, va_list ap)
342
{
343
    va_list ap2;
344
    char *iter = (char *)fmt;
345
    int len = 0;
346
    int nr_args = 0;
347
    char *arg_char_ptr;
348
    unsigned int arg_uint;
349
    unsigned long arg_ulong;
350

    
351
    /* Find the number of %'s that denotes an argument */
352
    for (iter = strstr(iter, "%"); iter; iter = strstr(iter, "%")) {
353
        nr_args++;
354
        iter++;
355
    }
356

    
357
    len = strlen(fmt) - 2*nr_args;
358

    
359
    if (!nr_args) {
360
        goto alloc_print;
361
    }
362

    
363
    va_copy(ap2, ap);
364

    
365
    iter = (char *)fmt;
366

    
367
    /* Now parse the format string */
368
    for (iter = strstr(iter, "%"); iter; iter = strstr(iter, "%")) {
369
        iter++;
370
        switch (*iter) {
371
        case 'u':
372
            arg_uint = va_arg(ap2, unsigned int);
373
            len += number_to_string((void *)&arg_uint, 'u');
374
            break;
375
        case 'l':
376
            if (*++iter == 'u') {
377
                arg_ulong = va_arg(ap2, unsigned long);
378
                len += number_to_string((void *)&arg_ulong, 'U');
379
            } else {
380
                return -1;
381
            }
382
            break;
383
        case 's':
384
            arg_char_ptr = va_arg(ap2, char *);
385
            len += strlen(arg_char_ptr);
386
            break;
387
        case 'c':
388
            len += 1;
389
            break;
390
        default:
391
            fprintf(stderr,
392
                    "v9fs_string_alloc_printf:Incorrect format %c", *iter);
393
            return -1;
394
        }
395
        iter++;
396
    }
397

    
398
alloc_print:
399
    *strp = qemu_malloc((len + 1) * sizeof(**strp));
400

    
401
    return vsprintf(*strp, fmt, ap);
402
}
403

    
404
static void GCC_FMT_ATTR(2, 3)
405
v9fs_string_sprintf(V9fsString *str, const char *fmt, ...)
406
{
407
    va_list ap;
408
    int err;
409

    
410
    v9fs_string_free(str);
411

    
412
    va_start(ap, fmt);
413
    err = v9fs_string_alloc_printf(&str->data, fmt, ap);
414
    BUG_ON(err == -1);
415
    va_end(ap);
416

    
417
    str->size = err;
418
}
419

    
420
static void v9fs_string_copy(V9fsString *lhs, V9fsString *rhs)
421
{
422
    v9fs_string_free(lhs);
423
    v9fs_string_sprintf(lhs, "%s", rhs->data);
424
}
425

    
426
static size_t v9fs_string_size(V9fsString *str)
427
{
428
    return str->size;
429
}
430

    
431
static V9fsFidState *lookup_fid(V9fsState *s, int32_t fid)
432
{
433
    V9fsFidState *f;
434

    
435
    for (f = s->fid_list; f; f = f->next) {
436
        if (f->fid == fid) {
437
            return f;
438
        }
439
    }
440

    
441
    return NULL;
442
}
443

    
444
static V9fsFidState *alloc_fid(V9fsState *s, int32_t fid)
445
{
446
    V9fsFidState *f;
447

    
448
    f = lookup_fid(s, fid);
449
    if (f) {
450
        return NULL;
451
    }
452

    
453
    f = qemu_mallocz(sizeof(V9fsFidState));
454

    
455
    f->fid = fid;
456
    f->fid_type = P9_FID_NONE;
457

    
458
    f->next = s->fid_list;
459
    s->fid_list = f;
460

    
461
    return f;
462
}
463

    
464
static int v9fs_xattr_fid_clunk(V9fsState *s, V9fsFidState *fidp)
465
{
466
    int retval = 0;
467

    
468
    if (fidp->fs.xattr.copied_len == -1) {
469
        /* getxattr/listxattr fid */
470
        goto free_value;
471
    }
472
    /*
473
     * if this is fid for setxattr. clunk should
474
     * result in setxattr localcall
475
     */
476
    if (fidp->fs.xattr.len != fidp->fs.xattr.copied_len) {
477
        /* clunk after partial write */
478
        retval = -EINVAL;
479
        goto free_out;
480
    }
481
    if (fidp->fs.xattr.len) {
482
        retval = v9fs_do_lsetxattr(s, &fidp->path, &fidp->fs.xattr.name,
483
                                   fidp->fs.xattr.value,
484
                                   fidp->fs.xattr.len,
485
                                   fidp->fs.xattr.flags);
486
    } else {
487
        retval = v9fs_do_lremovexattr(s, &fidp->path, &fidp->fs.xattr.name);
488
    }
489
free_out:
490
    v9fs_string_free(&fidp->fs.xattr.name);
491
free_value:
492
    if (fidp->fs.xattr.value) {
493
        qemu_free(fidp->fs.xattr.value);
494
    }
495
    return retval;
496
}
497

    
498
static int free_fid(V9fsState *s, int32_t fid)
499
{
500
    int retval = 0;
501
    V9fsFidState **fidpp, *fidp;
502

    
503
    for (fidpp = &s->fid_list; *fidpp; fidpp = &(*fidpp)->next) {
504
        if ((*fidpp)->fid == fid) {
505
            break;
506
        }
507
    }
508

    
509
    if (*fidpp == NULL) {
510
        return -ENOENT;
511
    }
512

    
513
    fidp = *fidpp;
514
    *fidpp = fidp->next;
515

    
516
    if (fidp->fid_type == P9_FID_FILE) {
517
        v9fs_do_close(s, fidp->fs.fd);
518
    } else if (fidp->fid_type == P9_FID_DIR) {
519
        v9fs_do_closedir(s, fidp->fs.dir);
520
    } else if (fidp->fid_type == P9_FID_XATTR) {
521
        retval = v9fs_xattr_fid_clunk(s, fidp);
522
    }
523
    v9fs_string_free(&fidp->path);
524
    qemu_free(fidp);
525

    
526
    return retval;
527
}
528

    
529
#define P9_QID_TYPE_DIR         0x80
530
#define P9_QID_TYPE_SYMLINK     0x02
531

    
532
#define P9_STAT_MODE_DIR        0x80000000
533
#define P9_STAT_MODE_APPEND     0x40000000
534
#define P9_STAT_MODE_EXCL       0x20000000
535
#define P9_STAT_MODE_MOUNT      0x10000000
536
#define P9_STAT_MODE_AUTH       0x08000000
537
#define P9_STAT_MODE_TMP        0x04000000
538
#define P9_STAT_MODE_SYMLINK    0x02000000
539
#define P9_STAT_MODE_LINK       0x01000000
540
#define P9_STAT_MODE_DEVICE     0x00800000
541
#define P9_STAT_MODE_NAMED_PIPE 0x00200000
542
#define P9_STAT_MODE_SOCKET     0x00100000
543
#define P9_STAT_MODE_SETUID     0x00080000
544
#define P9_STAT_MODE_SETGID     0x00040000
545
#define P9_STAT_MODE_SETVTX     0x00010000
546

    
547
#define P9_STAT_MODE_TYPE_BITS (P9_STAT_MODE_DIR |          \
548
                                P9_STAT_MODE_SYMLINK |      \
549
                                P9_STAT_MODE_LINK |         \
550
                                P9_STAT_MODE_DEVICE |       \
551
                                P9_STAT_MODE_NAMED_PIPE |   \
552
                                P9_STAT_MODE_SOCKET)
553

    
554
/* This is the algorithm from ufs in spfs */
555
static void stat_to_qid(const struct stat *stbuf, V9fsQID *qidp)
556
{
557
    size_t size;
558

    
559
    size = MIN(sizeof(stbuf->st_ino), sizeof(qidp->path));
560
    memcpy(&qidp->path, &stbuf->st_ino, size);
561
    qidp->version = stbuf->st_mtime ^ (stbuf->st_size << 8);
562
    qidp->type = 0;
563
    if (S_ISDIR(stbuf->st_mode)) {
564
        qidp->type |= P9_QID_TYPE_DIR;
565
    }
566
    if (S_ISLNK(stbuf->st_mode)) {
567
        qidp->type |= P9_QID_TYPE_SYMLINK;
568
    }
569
}
570

    
571
static int fid_to_qid(V9fsState *s, V9fsFidState *fidp, V9fsQID *qidp)
572
{
573
    struct stat stbuf;
574
    int err;
575

    
576
    err = v9fs_do_lstat(s, &fidp->path, &stbuf);
577
    if (err) {
578
        return err;
579
    }
580

    
581
    stat_to_qid(&stbuf, qidp);
582
    return 0;
583
}
584

    
585
static V9fsPDU *alloc_pdu(V9fsState *s)
586
{
587
    V9fsPDU *pdu = NULL;
588

    
589
    if (!QLIST_EMPTY(&s->free_list)) {
590
        pdu = QLIST_FIRST(&s->free_list);
591
        QLIST_REMOVE(pdu, next);
592
    }
593
    return pdu;
594
}
595

    
596
static void free_pdu(V9fsState *s, V9fsPDU *pdu)
597
{
598
    if (pdu) {
599
        QLIST_INSERT_HEAD(&s->free_list, pdu, next);
600
    }
601
}
602

    
603
size_t pdu_packunpack(void *addr, struct iovec *sg, int sg_count,
604
                        size_t offset, size_t size, int pack)
605
{
606
    int i = 0;
607
    size_t copied = 0;
608

    
609
    for (i = 0; size && i < sg_count; i++) {
610
        size_t len;
611
        if (offset >= sg[i].iov_len) {
612
            /* skip this sg */
613
            offset -= sg[i].iov_len;
614
            continue;
615
        } else {
616
            len = MIN(sg[i].iov_len - offset, size);
617
            if (pack) {
618
                memcpy(sg[i].iov_base + offset, addr, len);
619
            } else {
620
                memcpy(addr, sg[i].iov_base + offset, len);
621
            }
622
            size -= len;
623
            copied += len;
624
            addr += len;
625
            if (size) {
626
                offset = 0;
627
                continue;
628
            }
629
        }
630
    }
631

    
632
    return copied;
633
}
634

    
635
static size_t pdu_unpack(void *dst, V9fsPDU *pdu, size_t offset, size_t size)
636
{
637
    return pdu_packunpack(dst, pdu->elem.out_sg, pdu->elem.out_num,
638
                         offset, size, 0);
639
}
640

    
641
static size_t pdu_pack(V9fsPDU *pdu, size_t offset, const void *src,
642
                        size_t size)
643
{
644
    return pdu_packunpack((void *)src, pdu->elem.in_sg, pdu->elem.in_num,
645
                             offset, size, 1);
646
}
647

    
648
static int pdu_copy_sg(V9fsPDU *pdu, size_t offset, int rx, struct iovec *sg)
649
{
650
    size_t pos = 0;
651
    int i, j;
652
    struct iovec *src_sg;
653
    unsigned int num;
654

    
655
    if (rx) {
656
        src_sg = pdu->elem.in_sg;
657
        num = pdu->elem.in_num;
658
    } else {
659
        src_sg = pdu->elem.out_sg;
660
        num = pdu->elem.out_num;
661
    }
662

    
663
    j = 0;
664
    for (i = 0; i < num; i++) {
665
        if (offset <= pos) {
666
            sg[j].iov_base = src_sg[i].iov_base;
667
            sg[j].iov_len = src_sg[i].iov_len;
668
            j++;
669
        } else if (offset < (src_sg[i].iov_len + pos)) {
670
            sg[j].iov_base = src_sg[i].iov_base;
671
            sg[j].iov_len = src_sg[i].iov_len;
672
            sg[j].iov_base += (offset - pos);
673
            sg[j].iov_len -= (offset - pos);
674
            j++;
675
        }
676
        pos += src_sg[i].iov_len;
677
    }
678

    
679
    return j;
680
}
681

    
682
static size_t pdu_unmarshal(V9fsPDU *pdu, size_t offset, const char *fmt, ...)
683
{
684
    size_t old_offset = offset;
685
    va_list ap;
686
    int i;
687

    
688
    va_start(ap, fmt);
689
    for (i = 0; fmt[i]; i++) {
690
        switch (fmt[i]) {
691
        case 'b': {
692
            uint8_t *valp = va_arg(ap, uint8_t *);
693
            offset += pdu_unpack(valp, pdu, offset, sizeof(*valp));
694
            break;
695
        }
696
        case 'w': {
697
            uint16_t val, *valp;
698
            valp = va_arg(ap, uint16_t *);
699
            val = le16_to_cpupu(valp);
700
            offset += pdu_unpack(&val, pdu, offset, sizeof(val));
701
            *valp = val;
702
            break;
703
        }
704
        case 'd': {
705
            uint32_t val, *valp;
706
            valp = va_arg(ap, uint32_t *);
707
            val = le32_to_cpupu(valp);
708
            offset += pdu_unpack(&val, pdu, offset, sizeof(val));
709
            *valp = val;
710
            break;
711
        }
712
        case 'q': {
713
            uint64_t val, *valp;
714
            valp = va_arg(ap, uint64_t *);
715
            val = le64_to_cpup(valp);
716
            offset += pdu_unpack(&val, pdu, offset, sizeof(val));
717
            *valp = val;
718
            break;
719
        }
720
        case 'v': {
721
            struct iovec *iov = va_arg(ap, struct iovec *);
722
            int *iovcnt = va_arg(ap, int *);
723
            *iovcnt = pdu_copy_sg(pdu, offset, 0, iov);
724
            break;
725
        }
726
        case 's': {
727
            V9fsString *str = va_arg(ap, V9fsString *);
728
            offset += pdu_unmarshal(pdu, offset, "w", &str->size);
729
            /* FIXME: sanity check str->size */
730
            str->data = qemu_malloc(str->size + 1);
731
            offset += pdu_unpack(str->data, pdu, offset, str->size);
732
            str->data[str->size] = 0;
733
            break;
734
        }
735
        case 'Q': {
736
            V9fsQID *qidp = va_arg(ap, V9fsQID *);
737
            offset += pdu_unmarshal(pdu, offset, "bdq",
738
                        &qidp->type, &qidp->version, &qidp->path);
739
            break;
740
        }
741
        case 'S': {
742
            V9fsStat *statp = va_arg(ap, V9fsStat *);
743
            offset += pdu_unmarshal(pdu, offset, "wwdQdddqsssssddd",
744
                        &statp->size, &statp->type, &statp->dev,
745
                        &statp->qid, &statp->mode, &statp->atime,
746
                        &statp->mtime, &statp->length,
747
                        &statp->name, &statp->uid, &statp->gid,
748
                        &statp->muid, &statp->extension,
749
                        &statp->n_uid, &statp->n_gid,
750
                        &statp->n_muid);
751
            break;
752
        }
753
        case 'I': {
754
            V9fsIattr *iattr = va_arg(ap, V9fsIattr *);
755
            offset += pdu_unmarshal(pdu, offset, "ddddqqqqq",
756
                        &iattr->valid, &iattr->mode,
757
                        &iattr->uid, &iattr->gid, &iattr->size,
758
                        &iattr->atime_sec, &iattr->atime_nsec,
759
                        &iattr->mtime_sec, &iattr->mtime_nsec);
760
            break;
761
        }
762
        default:
763
            break;
764
        }
765
    }
766

    
767
    va_end(ap);
768

    
769
    return offset - old_offset;
770
}
771

    
772
static size_t pdu_marshal(V9fsPDU *pdu, size_t offset, const char *fmt, ...)
773
{
774
    size_t old_offset = offset;
775
    va_list ap;
776
    int i;
777

    
778
    va_start(ap, fmt);
779
    for (i = 0; fmt[i]; i++) {
780
        switch (fmt[i]) {
781
        case 'b': {
782
            uint8_t val = va_arg(ap, int);
783
            offset += pdu_pack(pdu, offset, &val, sizeof(val));
784
            break;
785
        }
786
        case 'w': {
787
            uint16_t val;
788
            cpu_to_le16w(&val, va_arg(ap, int));
789
            offset += pdu_pack(pdu, offset, &val, sizeof(val));
790
            break;
791
        }
792
        case 'd': {
793
            uint32_t val;
794
            cpu_to_le32w(&val, va_arg(ap, uint32_t));
795
            offset += pdu_pack(pdu, offset, &val, sizeof(val));
796
            break;
797
        }
798
        case 'q': {
799
            uint64_t val;
800
            cpu_to_le64w(&val, va_arg(ap, uint64_t));
801
            offset += pdu_pack(pdu, offset, &val, sizeof(val));
802
            break;
803
        }
804
        case 'v': {
805
            struct iovec *iov = va_arg(ap, struct iovec *);
806
            int *iovcnt = va_arg(ap, int *);
807
            *iovcnt = pdu_copy_sg(pdu, offset, 1, iov);
808
            break;
809
        }
810
        case 's': {
811
            V9fsString *str = va_arg(ap, V9fsString *);
812
            offset += pdu_marshal(pdu, offset, "w", str->size);
813
            offset += pdu_pack(pdu, offset, str->data, str->size);
814
            break;
815
        }
816
        case 'Q': {
817
            V9fsQID *qidp = va_arg(ap, V9fsQID *);
818
            offset += pdu_marshal(pdu, offset, "bdq",
819
                        qidp->type, qidp->version, qidp->path);
820
            break;
821
        }
822
        case 'S': {
823
            V9fsStat *statp = va_arg(ap, V9fsStat *);
824
            offset += pdu_marshal(pdu, offset, "wwdQdddqsssssddd",
825
                        statp->size, statp->type, statp->dev,
826
                        &statp->qid, statp->mode, statp->atime,
827
                        statp->mtime, statp->length, &statp->name,
828
                        &statp->uid, &statp->gid, &statp->muid,
829
                        &statp->extension, statp->n_uid,
830
                        statp->n_gid, statp->n_muid);
831
            break;
832
        }
833
        case 'A': {
834
            V9fsStatDotl *statp = va_arg(ap, V9fsStatDotl *);
835
            offset += pdu_marshal(pdu, offset, "qQdddqqqqqqqqqqqqqqq",
836
                        statp->st_result_mask,
837
                        &statp->qid, statp->st_mode,
838
                        statp->st_uid, statp->st_gid,
839
                        statp->st_nlink, statp->st_rdev,
840
                        statp->st_size, statp->st_blksize, statp->st_blocks,
841
                        statp->st_atime_sec, statp->st_atime_nsec,
842
                        statp->st_mtime_sec, statp->st_mtime_nsec,
843
                        statp->st_ctime_sec, statp->st_ctime_nsec,
844
                        statp->st_btime_sec, statp->st_btime_nsec,
845
                        statp->st_gen, statp->st_data_version);
846
            break;
847
        }
848
        default:
849
            break;
850
        }
851
    }
852
    va_end(ap);
853

    
854
    return offset - old_offset;
855
}
856

    
857
static void complete_pdu(V9fsState *s, V9fsPDU *pdu, ssize_t len)
858
{
859
    int8_t id = pdu->id + 1; /* Response */
860

    
861
    if (len < 0) {
862
        int err = -len;
863
        len = 7;
864

    
865
        if (s->proto_version != V9FS_PROTO_2000L) {
866
            V9fsString str;
867

    
868
            str.data = strerror(err);
869
            str.size = strlen(str.data);
870

    
871
            len += pdu_marshal(pdu, len, "s", &str);
872
            id = P9_RERROR;
873
        }
874

    
875
        len += pdu_marshal(pdu, len, "d", err);
876

    
877
        if (s->proto_version == V9FS_PROTO_2000L) {
878
            id = P9_RLERROR;
879
        }
880
    }
881

    
882
    /* fill out the header */
883
    pdu_marshal(pdu, 0, "dbw", (int32_t)len, id, pdu->tag);
884

    
885
    /* keep these in sync */
886
    pdu->size = len;
887
    pdu->id = id;
888

    
889
    /* push onto queue and notify */
890
    virtqueue_push(s->vq, &pdu->elem, len);
891

    
892
    /* FIXME: we should batch these completions */
893
    virtio_notify(&s->vdev, s->vq);
894

    
895
    free_pdu(s, pdu);
896
}
897

    
898
static mode_t v9mode_to_mode(uint32_t mode, V9fsString *extension)
899
{
900
    mode_t ret;
901

    
902
    ret = mode & 0777;
903
    if (mode & P9_STAT_MODE_DIR) {
904
        ret |= S_IFDIR;
905
    }
906

    
907
    if (mode & P9_STAT_MODE_SYMLINK) {
908
        ret |= S_IFLNK;
909
    }
910
    if (mode & P9_STAT_MODE_SOCKET) {
911
        ret |= S_IFSOCK;
912
    }
913
    if (mode & P9_STAT_MODE_NAMED_PIPE) {
914
        ret |= S_IFIFO;
915
    }
916
    if (mode & P9_STAT_MODE_DEVICE) {
917
        if (extension && extension->data[0] == 'c') {
918
            ret |= S_IFCHR;
919
        } else {
920
            ret |= S_IFBLK;
921
        }
922
    }
923

    
924
    if (!(ret&~0777)) {
925
        ret |= S_IFREG;
926
    }
927

    
928
    if (mode & P9_STAT_MODE_SETUID) {
929
        ret |= S_ISUID;
930
    }
931
    if (mode & P9_STAT_MODE_SETGID) {
932
        ret |= S_ISGID;
933
    }
934
    if (mode & P9_STAT_MODE_SETVTX) {
935
        ret |= S_ISVTX;
936
    }
937

    
938
    return ret;
939
}
940

    
941
static int donttouch_stat(V9fsStat *stat)
942
{
943
    if (stat->type == -1 &&
944
        stat->dev == -1 &&
945
        stat->qid.type == -1 &&
946
        stat->qid.version == -1 &&
947
        stat->qid.path == -1 &&
948
        stat->mode == -1 &&
949
        stat->atime == -1 &&
950
        stat->mtime == -1 &&
951
        stat->length == -1 &&
952
        !stat->name.size &&
953
        !stat->uid.size &&
954
        !stat->gid.size &&
955
        !stat->muid.size &&
956
        stat->n_uid == -1 &&
957
        stat->n_gid == -1 &&
958
        stat->n_muid == -1) {
959
        return 1;
960
    }
961

    
962
    return 0;
963
}
964

    
965
static void v9fs_stat_free(V9fsStat *stat)
966
{
967
    v9fs_string_free(&stat->name);
968
    v9fs_string_free(&stat->uid);
969
    v9fs_string_free(&stat->gid);
970
    v9fs_string_free(&stat->muid);
971
    v9fs_string_free(&stat->extension);
972
}
973

    
974
static uint32_t stat_to_v9mode(const struct stat *stbuf)
975
{
976
    uint32_t mode;
977

    
978
    mode = stbuf->st_mode & 0777;
979
    if (S_ISDIR(stbuf->st_mode)) {
980
        mode |= P9_STAT_MODE_DIR;
981
    }
982

    
983
    if (S_ISLNK(stbuf->st_mode)) {
984
        mode |= P9_STAT_MODE_SYMLINK;
985
    }
986

    
987
    if (S_ISSOCK(stbuf->st_mode)) {
988
        mode |= P9_STAT_MODE_SOCKET;
989
    }
990

    
991
    if (S_ISFIFO(stbuf->st_mode)) {
992
        mode |= P9_STAT_MODE_NAMED_PIPE;
993
    }
994

    
995
    if (S_ISBLK(stbuf->st_mode) || S_ISCHR(stbuf->st_mode)) {
996
        mode |= P9_STAT_MODE_DEVICE;
997
    }
998

    
999
    if (stbuf->st_mode & S_ISUID) {
1000
        mode |= P9_STAT_MODE_SETUID;
1001
    }
1002

    
1003
    if (stbuf->st_mode & S_ISGID) {
1004
        mode |= P9_STAT_MODE_SETGID;
1005
    }
1006

    
1007
    if (stbuf->st_mode & S_ISVTX) {
1008
        mode |= P9_STAT_MODE_SETVTX;
1009
    }
1010

    
1011
    return mode;
1012
}
1013

    
1014
static int stat_to_v9stat(V9fsState *s, V9fsString *name,
1015
                            const struct stat *stbuf,
1016
                            V9fsStat *v9stat)
1017
{
1018
    int err;
1019
    const char *str;
1020

    
1021
    memset(v9stat, 0, sizeof(*v9stat));
1022

    
1023
    stat_to_qid(stbuf, &v9stat->qid);
1024
    v9stat->mode = stat_to_v9mode(stbuf);
1025
    v9stat->atime = stbuf->st_atime;
1026
    v9stat->mtime = stbuf->st_mtime;
1027
    v9stat->length = stbuf->st_size;
1028

    
1029
    v9fs_string_null(&v9stat->uid);
1030
    v9fs_string_null(&v9stat->gid);
1031
    v9fs_string_null(&v9stat->muid);
1032

    
1033
    v9stat->n_uid = stbuf->st_uid;
1034
    v9stat->n_gid = stbuf->st_gid;
1035
    v9stat->n_muid = 0;
1036

    
1037
    v9fs_string_null(&v9stat->extension);
1038

    
1039
    if (v9stat->mode & P9_STAT_MODE_SYMLINK) {
1040
        err = v9fs_do_readlink(s, name, &v9stat->extension);
1041
        if (err == -1) {
1042
            err = -errno;
1043
            return err;
1044
        }
1045
        v9stat->extension.data[err] = 0;
1046
        v9stat->extension.size = err;
1047
    } else if (v9stat->mode & P9_STAT_MODE_DEVICE) {
1048
        v9fs_string_sprintf(&v9stat->extension, "%c %u %u",
1049
                S_ISCHR(stbuf->st_mode) ? 'c' : 'b',
1050
                major(stbuf->st_rdev), minor(stbuf->st_rdev));
1051
    } else if (S_ISDIR(stbuf->st_mode) || S_ISREG(stbuf->st_mode)) {
1052
        v9fs_string_sprintf(&v9stat->extension, "%s %lu",
1053
                "HARDLINKCOUNT", (unsigned long)stbuf->st_nlink);
1054
    }
1055

    
1056
    str = strrchr(name->data, '/');
1057
    if (str) {
1058
        str += 1;
1059
    } else {
1060
        str = name->data;
1061
    }
1062

    
1063
    v9fs_string_sprintf(&v9stat->name, "%s", str);
1064

    
1065
    v9stat->size = 61 +
1066
        v9fs_string_size(&v9stat->name) +
1067
        v9fs_string_size(&v9stat->uid) +
1068
        v9fs_string_size(&v9stat->gid) +
1069
        v9fs_string_size(&v9stat->muid) +
1070
        v9fs_string_size(&v9stat->extension);
1071
    return 0;
1072
}
1073

    
1074
#define P9_STATS_MODE          0x00000001ULL
1075
#define P9_STATS_NLINK         0x00000002ULL
1076
#define P9_STATS_UID           0x00000004ULL
1077
#define P9_STATS_GID           0x00000008ULL
1078
#define P9_STATS_RDEV          0x00000010ULL
1079
#define P9_STATS_ATIME         0x00000020ULL
1080
#define P9_STATS_MTIME         0x00000040ULL
1081
#define P9_STATS_CTIME         0x00000080ULL
1082
#define P9_STATS_INO           0x00000100ULL
1083
#define P9_STATS_SIZE          0x00000200ULL
1084
#define P9_STATS_BLOCKS        0x00000400ULL
1085

    
1086
#define P9_STATS_BTIME         0x00000800ULL
1087
#define P9_STATS_GEN           0x00001000ULL
1088
#define P9_STATS_DATA_VERSION  0x00002000ULL
1089

    
1090
#define P9_STATS_BASIC         0x000007ffULL /* Mask for fields up to BLOCKS */
1091
#define P9_STATS_ALL           0x00003fffULL /* Mask for All fields above */
1092

    
1093

    
1094
static void stat_to_v9stat_dotl(V9fsState *s, const struct stat *stbuf,
1095
                            V9fsStatDotl *v9lstat)
1096
{
1097
    memset(v9lstat, 0, sizeof(*v9lstat));
1098

    
1099
    v9lstat->st_mode = stbuf->st_mode;
1100
    v9lstat->st_nlink = stbuf->st_nlink;
1101
    v9lstat->st_uid = stbuf->st_uid;
1102
    v9lstat->st_gid = stbuf->st_gid;
1103
    v9lstat->st_rdev = stbuf->st_rdev;
1104
    v9lstat->st_size = stbuf->st_size;
1105
    v9lstat->st_blksize = stbuf->st_blksize;
1106
    v9lstat->st_blocks = stbuf->st_blocks;
1107
    v9lstat->st_atime_sec = stbuf->st_atime;
1108
    v9lstat->st_atime_nsec = stbuf->st_atim.tv_nsec;
1109
    v9lstat->st_mtime_sec = stbuf->st_mtime;
1110
    v9lstat->st_mtime_nsec = stbuf->st_mtim.tv_nsec;
1111
    v9lstat->st_ctime_sec = stbuf->st_ctime;
1112
    v9lstat->st_ctime_nsec = stbuf->st_ctim.tv_nsec;
1113
    /* Currently we only support BASIC fields in stat */
1114
    v9lstat->st_result_mask = P9_STATS_BASIC;
1115

    
1116
    stat_to_qid(stbuf, &v9lstat->qid);
1117
}
1118

    
1119
static struct iovec *adjust_sg(struct iovec *sg, int len, int *iovcnt)
1120
{
1121
    while (len && *iovcnt) {
1122
        if (len < sg->iov_len) {
1123
            sg->iov_len -= len;
1124
            sg->iov_base += len;
1125
            len = 0;
1126
        } else {
1127
            len -= sg->iov_len;
1128
            sg++;
1129
            *iovcnt -= 1;
1130
        }
1131
    }
1132

    
1133
    return sg;
1134
}
1135

    
1136
static struct iovec *cap_sg(struct iovec *sg, int cap, int *cnt)
1137
{
1138
    int i;
1139
    int total = 0;
1140

    
1141
    for (i = 0; i < *cnt; i++) {
1142
        if ((total + sg[i].iov_len) > cap) {
1143
            sg[i].iov_len -= ((total + sg[i].iov_len) - cap);
1144
            i++;
1145
            break;
1146
        }
1147
        total += sg[i].iov_len;
1148
    }
1149

    
1150
    *cnt = i;
1151

    
1152
    return sg;
1153
}
1154

    
1155
static void print_sg(struct iovec *sg, int cnt)
1156
{
1157
    int i;
1158

    
1159
    printf("sg[%d]: {", cnt);
1160
    for (i = 0; i < cnt; i++) {
1161
        if (i) {
1162
            printf(", ");
1163
        }
1164
        printf("(%p, %zd)", sg[i].iov_base, sg[i].iov_len);
1165
    }
1166
    printf("}\n");
1167
}
1168

    
1169
static void v9fs_fix_path(V9fsString *dst, V9fsString *src, int len)
1170
{
1171
    V9fsString str;
1172
    v9fs_string_init(&str);
1173
    v9fs_string_copy(&str, dst);
1174
    v9fs_string_sprintf(dst, "%s%s", src->data, str.data+len);
1175
    v9fs_string_free(&str);
1176
}
1177

    
1178
static void v9fs_version(V9fsState *s, V9fsPDU *pdu)
1179
{
1180
    V9fsString version;
1181
    size_t offset = 7;
1182

    
1183
    pdu_unmarshal(pdu, offset, "ds", &s->msize, &version);
1184

    
1185
    if (!strcmp(version.data, "9P2000.u")) {
1186
        s->proto_version = V9FS_PROTO_2000U;
1187
    } else if (!strcmp(version.data, "9P2000.L")) {
1188
        s->proto_version = V9FS_PROTO_2000L;
1189
    } else {
1190
        v9fs_string_sprintf(&version, "unknown");
1191
    }
1192

    
1193
    offset += pdu_marshal(pdu, offset, "ds", s->msize, &version);
1194
    complete_pdu(s, pdu, offset);
1195

    
1196
    v9fs_string_free(&version);
1197
}
1198

    
1199
static void v9fs_attach(V9fsState *s, V9fsPDU *pdu)
1200
{
1201
    int32_t fid, afid, n_uname;
1202
    V9fsString uname, aname;
1203
    V9fsFidState *fidp;
1204
    V9fsQID qid;
1205
    size_t offset = 7;
1206
    ssize_t err;
1207

    
1208
    pdu_unmarshal(pdu, offset, "ddssd", &fid, &afid, &uname, &aname, &n_uname);
1209

    
1210
    fidp = alloc_fid(s, fid);
1211
    if (fidp == NULL) {
1212
        err = -EINVAL;
1213
        goto out;
1214
    }
1215

    
1216
    fidp->uid = n_uname;
1217

    
1218
    v9fs_string_sprintf(&fidp->path, "%s", "/");
1219
    err = fid_to_qid(s, fidp, &qid);
1220
    if (err) {
1221
        err = -EINVAL;
1222
        free_fid(s, fid);
1223
        goto out;
1224
    }
1225

    
1226
    offset += pdu_marshal(pdu, offset, "Q", &qid);
1227

    
1228
    err = offset;
1229
out:
1230
    complete_pdu(s, pdu, err);
1231
    v9fs_string_free(&uname);
1232
    v9fs_string_free(&aname);
1233
}
1234

    
1235
static void v9fs_stat_post_lstat(V9fsState *s, V9fsStatState *vs, int err)
1236
{
1237
    if (err == -1) {
1238
        err = -errno;
1239
        goto out;
1240
    }
1241

    
1242
    err = stat_to_v9stat(s, &vs->fidp->path, &vs->stbuf, &vs->v9stat);
1243
    if (err) {
1244
        goto out;
1245
    }
1246
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "wS", 0, &vs->v9stat);
1247
    err = vs->offset;
1248

    
1249
out:
1250
    complete_pdu(s, vs->pdu, err);
1251
    v9fs_stat_free(&vs->v9stat);
1252
    qemu_free(vs);
1253
}
1254

    
1255
static void v9fs_stat(V9fsState *s, V9fsPDU *pdu)
1256
{
1257
    int32_t fid;
1258
    V9fsStatState *vs;
1259
    ssize_t err = 0;
1260

    
1261
    vs = qemu_malloc(sizeof(*vs));
1262
    vs->pdu = pdu;
1263
    vs->offset = 7;
1264

    
1265
    memset(&vs->v9stat, 0, sizeof(vs->v9stat));
1266

    
1267
    pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
1268

    
1269
    vs->fidp = lookup_fid(s, fid);
1270
    if (vs->fidp == NULL) {
1271
        err = -ENOENT;
1272
        goto out;
1273
    }
1274

    
1275
    err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1276
    v9fs_stat_post_lstat(s, vs, err);
1277
    return;
1278

    
1279
out:
1280
    complete_pdu(s, vs->pdu, err);
1281
    v9fs_stat_free(&vs->v9stat);
1282
    qemu_free(vs);
1283
}
1284

    
1285
static void v9fs_getattr_post_lstat(V9fsState *s, V9fsStatStateDotl *vs,
1286
                                                                int err)
1287
{
1288
    if (err == -1) {
1289
        err = -errno;
1290
        goto out;
1291
    }
1292

    
1293
    stat_to_v9stat_dotl(s, &vs->stbuf, &vs->v9stat_dotl);
1294
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "A", &vs->v9stat_dotl);
1295
    err = vs->offset;
1296

    
1297
out:
1298
    complete_pdu(s, vs->pdu, err);
1299
    qemu_free(vs);
1300
}
1301

    
1302
static void v9fs_getattr(V9fsState *s, V9fsPDU *pdu)
1303
{
1304
    int32_t fid;
1305
    V9fsStatStateDotl *vs;
1306
    ssize_t err = 0;
1307
    V9fsFidState *fidp;
1308
    uint64_t request_mask;
1309

    
1310
    vs = qemu_malloc(sizeof(*vs));
1311
    vs->pdu = pdu;
1312
    vs->offset = 7;
1313

    
1314
    memset(&vs->v9stat_dotl, 0, sizeof(vs->v9stat_dotl));
1315

    
1316
    pdu_unmarshal(vs->pdu, vs->offset, "dq", &fid, &request_mask);
1317

    
1318
    fidp = lookup_fid(s, fid);
1319
    if (fidp == NULL) {
1320
        err = -ENOENT;
1321
        goto out;
1322
    }
1323

    
1324
    /* Currently we only support BASIC fields in stat, so there is no
1325
     * need to look at request_mask.
1326
     */
1327
    err = v9fs_do_lstat(s, &fidp->path, &vs->stbuf);
1328
    v9fs_getattr_post_lstat(s, vs, err);
1329
    return;
1330

    
1331
out:
1332
    complete_pdu(s, vs->pdu, err);
1333
    qemu_free(vs);
1334
}
1335

    
1336
/* From Linux kernel code */
1337
#define ATTR_MODE    (1 << 0)
1338
#define ATTR_UID     (1 << 1)
1339
#define ATTR_GID     (1 << 2)
1340
#define ATTR_SIZE    (1 << 3)
1341
#define ATTR_ATIME   (1 << 4)
1342
#define ATTR_MTIME   (1 << 5)
1343
#define ATTR_CTIME   (1 << 6)
1344
#define ATTR_MASK    127
1345
#define ATTR_ATIME_SET  (1 << 7)
1346
#define ATTR_MTIME_SET  (1 << 8)
1347

    
1348
static void v9fs_setattr_post_truncate(V9fsState *s, V9fsSetattrState *vs,
1349
                                                                  int err)
1350
{
1351
    if (err == -1) {
1352
        err = -errno;
1353
        goto out;
1354
    }
1355
    err = vs->offset;
1356

    
1357
out:
1358
    complete_pdu(s, vs->pdu, err);
1359
    qemu_free(vs);
1360
}
1361

    
1362
static void v9fs_setattr_post_chown(V9fsState *s, V9fsSetattrState *vs, int err)
1363
{
1364
    if (err == -1) {
1365
        err = -errno;
1366
        goto out;
1367
    }
1368

    
1369
    if (vs->v9iattr.valid & (ATTR_SIZE)) {
1370
        err = v9fs_do_truncate(s, &vs->fidp->path, vs->v9iattr.size);
1371
    }
1372
    v9fs_setattr_post_truncate(s, vs, err);
1373
    return;
1374

    
1375
out:
1376
    complete_pdu(s, vs->pdu, err);
1377
    qemu_free(vs);
1378
}
1379

    
1380
static void v9fs_setattr_post_utimensat(V9fsState *s, V9fsSetattrState *vs,
1381
                                                                   int err)
1382
{
1383
    if (err == -1) {
1384
        err = -errno;
1385
        goto out;
1386
    }
1387

    
1388
    /* If the only valid entry in iattr is ctime we can call
1389
     * chown(-1,-1) to update the ctime of the file
1390
     */
1391
    if ((vs->v9iattr.valid & (ATTR_UID | ATTR_GID)) ||
1392
            ((vs->v9iattr.valid & ATTR_CTIME)
1393
            && !((vs->v9iattr.valid & ATTR_MASK) & ~ATTR_CTIME))) {
1394
        if (!(vs->v9iattr.valid & ATTR_UID)) {
1395
            vs->v9iattr.uid = -1;
1396
        }
1397
        if (!(vs->v9iattr.valid & ATTR_GID)) {
1398
            vs->v9iattr.gid = -1;
1399
        }
1400
        err = v9fs_do_chown(s, &vs->fidp->path, vs->v9iattr.uid,
1401
                                                vs->v9iattr.gid);
1402
    }
1403
    v9fs_setattr_post_chown(s, vs, err);
1404
    return;
1405

    
1406
out:
1407
    complete_pdu(s, vs->pdu, err);
1408
    qemu_free(vs);
1409
}
1410

    
1411
static void v9fs_setattr_post_chmod(V9fsState *s, V9fsSetattrState *vs, int err)
1412
{
1413
    if (err == -1) {
1414
        err = -errno;
1415
        goto out;
1416
    }
1417

    
1418
    if (vs->v9iattr.valid & (ATTR_ATIME | ATTR_MTIME)) {
1419
        struct timespec times[2];
1420
        if (vs->v9iattr.valid & ATTR_ATIME) {
1421
            if (vs->v9iattr.valid & ATTR_ATIME_SET) {
1422
                times[0].tv_sec = vs->v9iattr.atime_sec;
1423
                times[0].tv_nsec = vs->v9iattr.atime_nsec;
1424
            } else {
1425
                times[0].tv_nsec = UTIME_NOW;
1426
            }
1427
        } else {
1428
            times[0].tv_nsec = UTIME_OMIT;
1429
        }
1430

    
1431
        if (vs->v9iattr.valid & ATTR_MTIME) {
1432
            if (vs->v9iattr.valid & ATTR_MTIME_SET) {
1433
                times[1].tv_sec = vs->v9iattr.mtime_sec;
1434
                times[1].tv_nsec = vs->v9iattr.mtime_nsec;
1435
            } else {
1436
                times[1].tv_nsec = UTIME_NOW;
1437
            }
1438
        } else {
1439
            times[1].tv_nsec = UTIME_OMIT;
1440
        }
1441
        err = v9fs_do_utimensat(s, &vs->fidp->path, times);
1442
    }
1443
    v9fs_setattr_post_utimensat(s, vs, err);
1444
    return;
1445

    
1446
out:
1447
    complete_pdu(s, vs->pdu, err);
1448
    qemu_free(vs);
1449
}
1450

    
1451
static void v9fs_setattr(V9fsState *s, V9fsPDU *pdu)
1452
{
1453
    int32_t fid;
1454
    V9fsSetattrState *vs;
1455
    int err = 0;
1456

    
1457
    vs = qemu_malloc(sizeof(*vs));
1458
    vs->pdu = pdu;
1459
    vs->offset = 7;
1460

    
1461
    pdu_unmarshal(pdu, vs->offset, "dI", &fid, &vs->v9iattr);
1462

    
1463
    vs->fidp = lookup_fid(s, fid);
1464
    if (vs->fidp == NULL) {
1465
        err = -EINVAL;
1466
        goto out;
1467
    }
1468

    
1469
    if (vs->v9iattr.valid & ATTR_MODE) {
1470
        err = v9fs_do_chmod(s, &vs->fidp->path, vs->v9iattr.mode);
1471
    }
1472

    
1473
    v9fs_setattr_post_chmod(s, vs, err);
1474
    return;
1475

    
1476
out:
1477
    complete_pdu(s, vs->pdu, err);
1478
    qemu_free(vs);
1479
}
1480

    
1481
static void v9fs_walk_complete(V9fsState *s, V9fsWalkState *vs, int err)
1482
{
1483
    complete_pdu(s, vs->pdu, err);
1484

    
1485
    if (vs->nwnames) {
1486
        for (vs->name_idx = 0; vs->name_idx < vs->nwnames; vs->name_idx++) {
1487
            v9fs_string_free(&vs->wnames[vs->name_idx]);
1488
        }
1489

    
1490
        qemu_free(vs->wnames);
1491
        qemu_free(vs->qids);
1492
    }
1493
}
1494

    
1495
static void v9fs_walk_marshal(V9fsWalkState *vs)
1496
{
1497
    int i;
1498
    vs->offset = 7;
1499
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "w", vs->nwnames);
1500

    
1501
    for (i = 0; i < vs->nwnames; i++) {
1502
        vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qids[i]);
1503
    }
1504
}
1505

    
1506
static void v9fs_walk_post_newfid_lstat(V9fsState *s, V9fsWalkState *vs,
1507
                                                                int err)
1508
{
1509
    if (err == -1) {
1510
        free_fid(s, vs->newfidp->fid);
1511
        v9fs_string_free(&vs->path);
1512
        err = -ENOENT;
1513
        goto out;
1514
    }
1515

    
1516
    stat_to_qid(&vs->stbuf, &vs->qids[vs->name_idx]);
1517

    
1518
    vs->name_idx++;
1519
    if (vs->name_idx < vs->nwnames) {
1520
        v9fs_string_sprintf(&vs->path, "%s/%s", vs->newfidp->path.data,
1521
                                            vs->wnames[vs->name_idx].data);
1522
        v9fs_string_copy(&vs->newfidp->path, &vs->path);
1523

    
1524
        err = v9fs_do_lstat(s, &vs->newfidp->path, &vs->stbuf);
1525
        v9fs_walk_post_newfid_lstat(s, vs, err);
1526
        return;
1527
    }
1528

    
1529
    v9fs_string_free(&vs->path);
1530
    v9fs_walk_marshal(vs);
1531
    err = vs->offset;
1532
out:
1533
    v9fs_walk_complete(s, vs, err);
1534
}
1535

    
1536
static void v9fs_walk_post_oldfid_lstat(V9fsState *s, V9fsWalkState *vs,
1537
        int err)
1538
{
1539
    if (err == -1) {
1540
        v9fs_string_free(&vs->path);
1541
        err = -ENOENT;
1542
        goto out;
1543
    }
1544

    
1545
    stat_to_qid(&vs->stbuf, &vs->qids[vs->name_idx]);
1546
    vs->name_idx++;
1547
    if (vs->name_idx < vs->nwnames) {
1548

    
1549
        v9fs_string_sprintf(&vs->path, "%s/%s",
1550
                vs->fidp->path.data, vs->wnames[vs->name_idx].data);
1551
        v9fs_string_copy(&vs->fidp->path, &vs->path);
1552

    
1553
        err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1554
        v9fs_walk_post_oldfid_lstat(s, vs, err);
1555
        return;
1556
    }
1557

    
1558
    v9fs_string_free(&vs->path);
1559
    v9fs_walk_marshal(vs);
1560
    err = vs->offset;
1561
out:
1562
    v9fs_walk_complete(s, vs, err);
1563
}
1564

    
1565
static void v9fs_walk(V9fsState *s, V9fsPDU *pdu)
1566
{
1567
    int32_t fid, newfid;
1568
    V9fsWalkState *vs;
1569
    int err = 0;
1570
    int i;
1571

    
1572
    vs = qemu_malloc(sizeof(*vs));
1573
    vs->pdu = pdu;
1574
    vs->wnames = NULL;
1575
    vs->qids = NULL;
1576
    vs->offset = 7;
1577

    
1578
    vs->offset += pdu_unmarshal(vs->pdu, vs->offset, "ddw", &fid,
1579
                                            &newfid, &vs->nwnames);
1580

    
1581
    if (vs->nwnames) {
1582
        vs->wnames = qemu_mallocz(sizeof(vs->wnames[0]) * vs->nwnames);
1583

    
1584
        vs->qids = qemu_mallocz(sizeof(vs->qids[0]) * vs->nwnames);
1585

    
1586
        for (i = 0; i < vs->nwnames; i++) {
1587
            vs->offset += pdu_unmarshal(vs->pdu, vs->offset, "s",
1588
                                            &vs->wnames[i]);
1589
        }
1590
    }
1591

    
1592
    vs->fidp = lookup_fid(s, fid);
1593
    if (vs->fidp == NULL) {
1594
        err = -ENOENT;
1595
        goto out;
1596
    }
1597

    
1598
    /* FIXME: is this really valid? */
1599
    if (fid == newfid) {
1600

    
1601
        BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
1602
        v9fs_string_init(&vs->path);
1603
        vs->name_idx = 0;
1604

    
1605
        if (vs->name_idx < vs->nwnames) {
1606
            v9fs_string_sprintf(&vs->path, "%s/%s",
1607
                vs->fidp->path.data, vs->wnames[vs->name_idx].data);
1608
            v9fs_string_copy(&vs->fidp->path, &vs->path);
1609

    
1610
            err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1611
            v9fs_walk_post_oldfid_lstat(s, vs, err);
1612
            return;
1613
        }
1614
    } else {
1615
        vs->newfidp = alloc_fid(s, newfid);
1616
        if (vs->newfidp == NULL) {
1617
            err = -EINVAL;
1618
            goto out;
1619
        }
1620

    
1621
        vs->newfidp->uid = vs->fidp->uid;
1622
        v9fs_string_init(&vs->path);
1623
        vs->name_idx = 0;
1624
        v9fs_string_copy(&vs->newfidp->path, &vs->fidp->path);
1625

    
1626
        if (vs->name_idx < vs->nwnames) {
1627
            v9fs_string_sprintf(&vs->path, "%s/%s", vs->newfidp->path.data,
1628
                                vs->wnames[vs->name_idx].data);
1629
            v9fs_string_copy(&vs->newfidp->path, &vs->path);
1630

    
1631
            err = v9fs_do_lstat(s, &vs->newfidp->path, &vs->stbuf);
1632
            v9fs_walk_post_newfid_lstat(s, vs, err);
1633
            return;
1634
        }
1635
    }
1636

    
1637
    v9fs_walk_marshal(vs);
1638
    err = vs->offset;
1639
out:
1640
    v9fs_walk_complete(s, vs, err);
1641
}
1642

    
1643
static int32_t get_iounit(V9fsState *s, V9fsString *name)
1644
{
1645
    struct statfs stbuf;
1646
    int32_t iounit = 0;
1647

    
1648
    /*
1649
     * iounit should be multiples of f_bsize (host filesystem block size
1650
     * and as well as less than (client msize - P9_IOHDRSZ))
1651
     */
1652
    if (!v9fs_do_statfs(s, name, &stbuf)) {
1653
        iounit = stbuf.f_bsize;
1654
        iounit *= (s->msize - P9_IOHDRSZ)/stbuf.f_bsize;
1655
    }
1656

    
1657
    if (!iounit) {
1658
        iounit = s->msize - P9_IOHDRSZ;
1659
    }
1660
    return iounit;
1661
}
1662

    
1663
static void v9fs_open_post_opendir(V9fsState *s, V9fsOpenState *vs, int err)
1664
{
1665
    if (vs->fidp->fs.dir == NULL) {
1666
        err = -errno;
1667
        goto out;
1668
    }
1669
    vs->fidp->fid_type = P9_FID_DIR;
1670
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, 0);
1671
    err = vs->offset;
1672
out:
1673
    complete_pdu(s, vs->pdu, err);
1674
    qemu_free(vs);
1675

    
1676
}
1677

    
1678
static void v9fs_open_post_getiounit(V9fsState *s, V9fsOpenState *vs)
1679
{
1680
    int err;
1681
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, vs->iounit);
1682
    err = vs->offset;
1683
    complete_pdu(s, vs->pdu, err);
1684
    qemu_free(vs);
1685
}
1686

    
1687
static void v9fs_open_post_open(V9fsState *s, V9fsOpenState *vs, int err)
1688
{
1689
    if (vs->fidp->fs.fd == -1) {
1690
        err = -errno;
1691
        goto out;
1692
    }
1693
    vs->fidp->fid_type = P9_FID_FILE;
1694
    vs->iounit = get_iounit(s, &vs->fidp->path);
1695
    v9fs_open_post_getiounit(s, vs);
1696
    return;
1697
out:
1698
    complete_pdu(s, vs->pdu, err);
1699
    qemu_free(vs);
1700
}
1701

    
1702
static void v9fs_open_post_lstat(V9fsState *s, V9fsOpenState *vs, int err)
1703
{
1704
    int flags;
1705

    
1706
    if (err) {
1707
        err = -errno;
1708
        goto out;
1709
    }
1710

    
1711
    stat_to_qid(&vs->stbuf, &vs->qid);
1712

    
1713
    if (S_ISDIR(vs->stbuf.st_mode)) {
1714
        vs->fidp->fs.dir = v9fs_do_opendir(s, &vs->fidp->path);
1715
        v9fs_open_post_opendir(s, vs, err);
1716
    } else {
1717
        if (s->proto_version == V9FS_PROTO_2000L) {
1718
            flags = vs->mode;
1719
            flags &= ~(O_NOCTTY | O_ASYNC | O_CREAT);
1720
            /* Ignore direct disk access hint until the server supports it. */
1721
            flags &= ~O_DIRECT;
1722
        } else {
1723
            flags = omode_to_uflags(vs->mode);
1724
        }
1725
        vs->fidp->fs.fd = v9fs_do_open(s, &vs->fidp->path, flags);
1726
        v9fs_open_post_open(s, vs, err);
1727
    }
1728
    return;
1729
out:
1730
    complete_pdu(s, vs->pdu, err);
1731
    qemu_free(vs);
1732
}
1733

    
1734
static void v9fs_open(V9fsState *s, V9fsPDU *pdu)
1735
{
1736
    int32_t fid;
1737
    V9fsOpenState *vs;
1738
    ssize_t err = 0;
1739

    
1740
    vs = qemu_malloc(sizeof(*vs));
1741
    vs->pdu = pdu;
1742
    vs->offset = 7;
1743
    vs->mode = 0;
1744

    
1745
    if (s->proto_version == V9FS_PROTO_2000L) {
1746
        pdu_unmarshal(vs->pdu, vs->offset, "dd", &fid, &vs->mode);
1747
    } else {
1748
        pdu_unmarshal(vs->pdu, vs->offset, "db", &fid, &vs->mode);
1749
    }
1750

    
1751
    vs->fidp = lookup_fid(s, fid);
1752
    if (vs->fidp == NULL) {
1753
        err = -ENOENT;
1754
        goto out;
1755
    }
1756

    
1757
    BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
1758

    
1759
    err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1760

    
1761
    v9fs_open_post_lstat(s, vs, err);
1762
    return;
1763
out:
1764
    complete_pdu(s, pdu, err);
1765
    qemu_free(vs);
1766
}
1767

    
1768
static void v9fs_post_lcreate(V9fsState *s, V9fsLcreateState *vs, int err)
1769
{
1770
    if (err == 0) {
1771
        v9fs_string_copy(&vs->fidp->path, &vs->fullname);
1772
        stat_to_qid(&vs->stbuf, &vs->qid);
1773
        vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid,
1774
                &vs->iounit);
1775
        err = vs->offset;
1776
    } else {
1777
        vs->fidp->fid_type = P9_FID_NONE;
1778
        err = -errno;
1779
        if (vs->fidp->fs.fd > 0) {
1780
            close(vs->fidp->fs.fd);
1781
        }
1782
    }
1783

    
1784
    complete_pdu(s, vs->pdu, err);
1785
    v9fs_string_free(&vs->name);
1786
    v9fs_string_free(&vs->fullname);
1787
    qemu_free(vs);
1788
}
1789

    
1790
static void v9fs_lcreate_post_get_iounit(V9fsState *s, V9fsLcreateState *vs,
1791
        int err)
1792
{
1793
    if (err) {
1794
        err = -errno;
1795
        goto out;
1796
    }
1797
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
1798

    
1799
out:
1800
    v9fs_post_lcreate(s, vs, err);
1801
}
1802

    
1803
static void v9fs_lcreate_post_do_open2(V9fsState *s, V9fsLcreateState *vs,
1804
        int err)
1805
{
1806
    if (vs->fidp->fs.fd == -1) {
1807
        err = -errno;
1808
        goto out;
1809
    }
1810
    vs->fidp->fid_type = P9_FID_FILE;
1811
    vs->iounit =  get_iounit(s, &vs->fullname);
1812
    v9fs_lcreate_post_get_iounit(s, vs, err);
1813
    return;
1814

    
1815
out:
1816
    v9fs_post_lcreate(s, vs, err);
1817
}
1818

    
1819
static void v9fs_lcreate(V9fsState *s, V9fsPDU *pdu)
1820
{
1821
    int32_t dfid, flags, mode;
1822
    gid_t gid;
1823
    V9fsLcreateState *vs;
1824
    ssize_t err = 0;
1825

    
1826
    vs = qemu_malloc(sizeof(*vs));
1827
    vs->pdu = pdu;
1828
    vs->offset = 7;
1829

    
1830
    v9fs_string_init(&vs->fullname);
1831

    
1832
    pdu_unmarshal(vs->pdu, vs->offset, "dsddd", &dfid, &vs->name, &flags,
1833
            &mode, &gid);
1834

    
1835
    vs->fidp = lookup_fid(s, dfid);
1836
    if (vs->fidp == NULL) {
1837
        err = -ENOENT;
1838
        goto out;
1839
    }
1840

    
1841
    v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->fidp->path.data,
1842
             vs->name.data);
1843

    
1844
    /* Ignore direct disk access hint until the server supports it. */
1845
    flags &= ~O_DIRECT;
1846

    
1847
    vs->fidp->fs.fd = v9fs_do_open2(s, vs->fullname.data, vs->fidp->uid,
1848
            gid, flags, mode);
1849
    v9fs_lcreate_post_do_open2(s, vs, err);
1850
    return;
1851

    
1852
out:
1853
    complete_pdu(s, vs->pdu, err);
1854
    v9fs_string_free(&vs->name);
1855
    qemu_free(vs);
1856
}
1857

    
1858
static void v9fs_post_do_fsync(V9fsState *s, V9fsPDU *pdu, int err)
1859
{
1860
    if (err == -1) {
1861
        err = -errno;
1862
    }
1863
    complete_pdu(s, pdu, err);
1864
}
1865

    
1866
static void v9fs_fsync(V9fsState *s, V9fsPDU *pdu)
1867
{
1868
    int32_t fid;
1869
    size_t offset = 7;
1870
    V9fsFidState *fidp;
1871
    int err;
1872

    
1873
    pdu_unmarshal(pdu, offset, "d", &fid);
1874
    fidp = lookup_fid(s, fid);
1875
    if (fidp == NULL) {
1876
        err = -ENOENT;
1877
        v9fs_post_do_fsync(s, pdu, err);
1878
        return;
1879
    }
1880
    err = v9fs_do_fsync(s, fidp->fs.fd);
1881
    v9fs_post_do_fsync(s, pdu, err);
1882
}
1883

    
1884
static void v9fs_clunk(V9fsState *s, V9fsPDU *pdu)
1885
{
1886
    int32_t fid;
1887
    size_t offset = 7;
1888
    int err;
1889

    
1890
    pdu_unmarshal(pdu, offset, "d", &fid);
1891

    
1892
    err = free_fid(s, fid);
1893
    if (err < 0) {
1894
        goto out;
1895
    }
1896

    
1897
    offset = 7;
1898
    err = offset;
1899
out:
1900
    complete_pdu(s, pdu, err);
1901
}
1902

    
1903
static void v9fs_read_post_readdir(V9fsState *, V9fsReadState *, ssize_t);
1904

    
1905
static void v9fs_read_post_seekdir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1906
{
1907
    if (err) {
1908
        goto out;
1909
    }
1910
    v9fs_stat_free(&vs->v9stat);
1911
    v9fs_string_free(&vs->name);
1912
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
1913
    vs->offset += vs->count;
1914
    err = vs->offset;
1915
out:
1916
    complete_pdu(s, vs->pdu, err);
1917
    qemu_free(vs);
1918
    return;
1919
}
1920

    
1921
static void v9fs_read_post_dir_lstat(V9fsState *s, V9fsReadState *vs,
1922
                                    ssize_t err)
1923
{
1924
    if (err) {
1925
        err = -errno;
1926
        goto out;
1927
    }
1928
    err = stat_to_v9stat(s, &vs->name, &vs->stbuf, &vs->v9stat);
1929
    if (err) {
1930
        goto out;
1931
    }
1932

    
1933
    vs->len = pdu_marshal(vs->pdu, vs->offset + 4 + vs->count, "S",
1934
                            &vs->v9stat);
1935
    if ((vs->len != (vs->v9stat.size + 2)) ||
1936
            ((vs->count + vs->len) > vs->max_count)) {
1937
        v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->dir_pos);
1938
        v9fs_read_post_seekdir(s, vs, err);
1939
        return;
1940
    }
1941
    vs->count += vs->len;
1942
    v9fs_stat_free(&vs->v9stat);
1943
    v9fs_string_free(&vs->name);
1944
    vs->dir_pos = vs->dent->d_off;
1945
    vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
1946
    v9fs_read_post_readdir(s, vs, err);
1947
    return;
1948
out:
1949
    v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->dir_pos);
1950
    v9fs_read_post_seekdir(s, vs, err);
1951
    return;
1952

    
1953
}
1954

    
1955
static void v9fs_read_post_readdir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1956
{
1957
    if (vs->dent) {
1958
        memset(&vs->v9stat, 0, sizeof(vs->v9stat));
1959
        v9fs_string_init(&vs->name);
1960
        v9fs_string_sprintf(&vs->name, "%s/%s", vs->fidp->path.data,
1961
                            vs->dent->d_name);
1962
        err = v9fs_do_lstat(s, &vs->name, &vs->stbuf);
1963
        v9fs_read_post_dir_lstat(s, vs, err);
1964
        return;
1965
    }
1966

    
1967
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
1968
    vs->offset += vs->count;
1969
    err = vs->offset;
1970
    complete_pdu(s, vs->pdu, err);
1971
    qemu_free(vs);
1972
    return;
1973
}
1974

    
1975
static void v9fs_read_post_telldir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1976
{
1977
    vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
1978
    v9fs_read_post_readdir(s, vs, err);
1979
    return;
1980
}
1981

    
1982
static void v9fs_read_post_rewinddir(V9fsState *s, V9fsReadState *vs,
1983
                                       ssize_t err)
1984
{
1985
    vs->dir_pos = v9fs_do_telldir(s, vs->fidp->fs.dir);
1986
    v9fs_read_post_telldir(s, vs, err);
1987
    return;
1988
}
1989

    
1990
static void v9fs_read_post_preadv(V9fsState *s, V9fsReadState *vs, ssize_t err)
1991
{
1992
    if (err  < 0) {
1993
        /* IO error return the error */
1994
        err = -errno;
1995
        goto out;
1996
    }
1997
    vs->total += vs->len;
1998
    vs->sg = adjust_sg(vs->sg, vs->len, &vs->cnt);
1999
    if (vs->total < vs->count && vs->len > 0) {
2000
        do {
2001
            if (0) {
2002
                print_sg(vs->sg, vs->cnt);
2003
            }
2004
            vs->len = v9fs_do_preadv(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2005
                      vs->off);
2006
            if (vs->len > 0) {
2007
                vs->off += vs->len;
2008
            }
2009
        } while (vs->len == -1 && errno == EINTR);
2010
        if (vs->len == -1) {
2011
            err  = -errno;
2012
        }
2013
        v9fs_read_post_preadv(s, vs, err);
2014
        return;
2015
    }
2016
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->total);
2017
    vs->offset += vs->count;
2018
    err = vs->offset;
2019

    
2020
out:
2021
    complete_pdu(s, vs->pdu, err);
2022
    qemu_free(vs);
2023
}
2024

    
2025
static void v9fs_xattr_read(V9fsState *s, V9fsReadState *vs)
2026
{
2027
    ssize_t err = 0;
2028
    int read_count;
2029
    int64_t xattr_len;
2030

    
2031
    xattr_len = vs->fidp->fs.xattr.len;
2032
    read_count = xattr_len - vs->off;
2033
    if (read_count > vs->count) {
2034
        read_count = vs->count;
2035
    } else if (read_count < 0) {
2036
        /*
2037
         * read beyond XATTR value
2038
         */
2039
        read_count = 0;
2040
    }
2041
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", read_count);
2042
    vs->offset += pdu_pack(vs->pdu, vs->offset,
2043
                           ((char *)vs->fidp->fs.xattr.value) + vs->off,
2044
                           read_count);
2045
    err = vs->offset;
2046
    complete_pdu(s, vs->pdu, err);
2047
    qemu_free(vs);
2048
}
2049

    
2050
static void v9fs_read(V9fsState *s, V9fsPDU *pdu)
2051
{
2052
    int32_t fid;
2053
    V9fsReadState *vs;
2054
    ssize_t err = 0;
2055

    
2056
    vs = qemu_malloc(sizeof(*vs));
2057
    vs->pdu = pdu;
2058
    vs->offset = 7;
2059
    vs->total = 0;
2060
    vs->len = 0;
2061
    vs->count = 0;
2062

    
2063
    pdu_unmarshal(vs->pdu, vs->offset, "dqd", &fid, &vs->off, &vs->count);
2064

    
2065
    vs->fidp = lookup_fid(s, fid);
2066
    if (vs->fidp == NULL) {
2067
        err = -EINVAL;
2068
        goto out;
2069
    }
2070

    
2071
    if (vs->fidp->fid_type == P9_FID_DIR) {
2072
        vs->max_count = vs->count;
2073
        vs->count = 0;
2074
        if (vs->off == 0) {
2075
            v9fs_do_rewinddir(s, vs->fidp->fs.dir);
2076
        }
2077
        v9fs_read_post_rewinddir(s, vs, err);
2078
        return;
2079
    } else if (vs->fidp->fid_type == P9_FID_FILE) {
2080
        vs->sg = vs->iov;
2081
        pdu_marshal(vs->pdu, vs->offset + 4, "v", vs->sg, &vs->cnt);
2082
        vs->sg = cap_sg(vs->sg, vs->count, &vs->cnt);
2083
        if (vs->total <= vs->count) {
2084
            vs->len = v9fs_do_preadv(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2085
                                    vs->off);
2086
            if (vs->len > 0) {
2087
                vs->off += vs->len;
2088
            }
2089
            err = vs->len;
2090
            v9fs_read_post_preadv(s, vs, err);
2091
        }
2092
        return;
2093
    } else if (vs->fidp->fid_type == P9_FID_XATTR) {
2094
        v9fs_xattr_read(s, vs);
2095
        return;
2096
    } else {
2097
        err = -EINVAL;
2098
    }
2099
out:
2100
    complete_pdu(s, pdu, err);
2101
    qemu_free(vs);
2102
}
2103

    
2104
typedef struct V9fsReadDirState {
2105
    V9fsPDU *pdu;
2106
    V9fsFidState *fidp;
2107
    V9fsQID qid;
2108
    off_t saved_dir_pos;
2109
    struct dirent *dent;
2110
    int32_t count;
2111
    int32_t max_count;
2112
    size_t offset;
2113
    int64_t initial_offset;
2114
    V9fsString name;
2115
} V9fsReadDirState;
2116

    
2117
static void v9fs_readdir_post_seekdir(V9fsState *s, V9fsReadDirState *vs)
2118
{
2119
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
2120
    vs->offset += vs->count;
2121
    complete_pdu(s, vs->pdu, vs->offset);
2122
    qemu_free(vs);
2123
    return;
2124
}
2125

    
2126
/* Size of each dirent on the wire: size of qid (13) + size of offset (8)
2127
 * size of type (1) + size of name.size (2) + strlen(name.data)
2128
 */
2129
#define V9_READDIR_DATA_SZ (24 + strlen(vs->name.data))
2130

    
2131
static void v9fs_readdir_post_readdir(V9fsState *s, V9fsReadDirState *vs)
2132
{
2133
    int len;
2134
    size_t size;
2135

    
2136
    if (vs->dent) {
2137
        v9fs_string_init(&vs->name);
2138
        v9fs_string_sprintf(&vs->name, "%s", vs->dent->d_name);
2139

    
2140
        if ((vs->count + V9_READDIR_DATA_SZ) > vs->max_count) {
2141
            /* Ran out of buffer. Set dir back to old position and return */
2142
            v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->saved_dir_pos);
2143
            v9fs_readdir_post_seekdir(s, vs);
2144
            return;
2145
        }
2146

    
2147
        /* Fill up just the path field of qid because the client uses
2148
         * only that. To fill the entire qid structure we will have
2149
         * to stat each dirent found, which is expensive
2150
         */
2151
        size = MIN(sizeof(vs->dent->d_ino), sizeof(vs->qid.path));
2152
        memcpy(&vs->qid.path, &vs->dent->d_ino, size);
2153
        /* Fill the other fields with dummy values */
2154
        vs->qid.type = 0;
2155
        vs->qid.version = 0;
2156

    
2157
        len = pdu_marshal(vs->pdu, vs->offset+4+vs->count, "Qqbs",
2158
                              &vs->qid, vs->dent->d_off,
2159
                              vs->dent->d_type, &vs->name);
2160
        vs->count += len;
2161
        v9fs_string_free(&vs->name);
2162
        vs->saved_dir_pos = vs->dent->d_off;
2163
        vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
2164
        v9fs_readdir_post_readdir(s, vs);
2165
        return;
2166
    }
2167

    
2168
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
2169
    vs->offset += vs->count;
2170
    complete_pdu(s, vs->pdu, vs->offset);
2171
    qemu_free(vs);
2172
    return;
2173
}
2174

    
2175
static void v9fs_readdir_post_telldir(V9fsState *s, V9fsReadDirState *vs)
2176
{
2177
    vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
2178
    v9fs_readdir_post_readdir(s, vs);
2179
    return;
2180
}
2181

    
2182
static void v9fs_readdir_post_setdir(V9fsState *s, V9fsReadDirState *vs)
2183
{
2184
    vs->saved_dir_pos = v9fs_do_telldir(s, vs->fidp->fs.dir);
2185
    v9fs_readdir_post_telldir(s, vs);
2186
    return;
2187
}
2188

    
2189
static void v9fs_readdir(V9fsState *s, V9fsPDU *pdu)
2190
{
2191
    int32_t fid;
2192
    V9fsReadDirState *vs;
2193
    ssize_t err = 0;
2194
    size_t offset = 7;
2195

    
2196
    vs = qemu_malloc(sizeof(*vs));
2197
    vs->pdu = pdu;
2198
    vs->offset = 7;
2199
    vs->count = 0;
2200

    
2201
    pdu_unmarshal(vs->pdu, offset, "dqd", &fid, &vs->initial_offset,
2202
                                                        &vs->max_count);
2203

    
2204
    vs->fidp = lookup_fid(s, fid);
2205
    if (vs->fidp == NULL || !(vs->fidp->fs.dir)) {
2206
        err = -EINVAL;
2207
        goto out;
2208
    }
2209

    
2210
    if (vs->initial_offset == 0) {
2211
        v9fs_do_rewinddir(s, vs->fidp->fs.dir);
2212
    } else {
2213
        v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->initial_offset);
2214
    }
2215

    
2216
    v9fs_readdir_post_setdir(s, vs);
2217
    return;
2218

    
2219
out:
2220
    complete_pdu(s, pdu, err);
2221
    qemu_free(vs);
2222
    return;
2223
}
2224

    
2225
static void v9fs_write_post_pwritev(V9fsState *s, V9fsWriteState *vs,
2226
                                   ssize_t err)
2227
{
2228
    if (err  < 0) {
2229
        /* IO error return the error */
2230
        err = -errno;
2231
        goto out;
2232
    }
2233
    vs->total += vs->len;
2234
    vs->sg = adjust_sg(vs->sg, vs->len, &vs->cnt);
2235
    if (vs->total < vs->count && vs->len > 0) {
2236
        do {
2237
            if (0) {
2238
                print_sg(vs->sg, vs->cnt);
2239
            }
2240
            vs->len = v9fs_do_pwritev(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2241
                      vs->off);
2242
            if (vs->len > 0) {
2243
                vs->off += vs->len;
2244
            }
2245
        } while (vs->len == -1 && errno == EINTR);
2246
        if (vs->len == -1) {
2247
            err  = -errno;
2248
        }
2249
        v9fs_write_post_pwritev(s, vs, err);
2250
        return;
2251
    }
2252
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->total);
2253
    err = vs->offset;
2254
out:
2255
    complete_pdu(s, vs->pdu, err);
2256
    qemu_free(vs);
2257
}
2258

    
2259
static void v9fs_xattr_write(V9fsState *s, V9fsWriteState *vs)
2260
{
2261
    int i, to_copy;
2262
    ssize_t err = 0;
2263
    int write_count;
2264
    int64_t xattr_len;
2265

    
2266
    xattr_len = vs->fidp->fs.xattr.len;
2267
    write_count = xattr_len - vs->off;
2268
    if (write_count > vs->count) {
2269
        write_count = vs->count;
2270
    } else if (write_count < 0) {
2271
        /*
2272
         * write beyond XATTR value len specified in
2273
         * xattrcreate
2274
         */
2275
        err = -ENOSPC;
2276
        goto out;
2277
    }
2278
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", write_count);
2279
    err = vs->offset;
2280
    vs->fidp->fs.xattr.copied_len += write_count;
2281
    /*
2282
     * Now copy the content from sg list
2283
     */
2284
    for (i = 0; i < vs->cnt; i++) {
2285
        if (write_count > vs->sg[i].iov_len) {
2286
            to_copy = vs->sg[i].iov_len;
2287
        } else {
2288
            to_copy = write_count;
2289
        }
2290
        memcpy((char *)vs->fidp->fs.xattr.value + vs->off,
2291
               vs->sg[i].iov_base, to_copy);
2292
        /* updating vs->off since we are not using below */
2293
        vs->off += to_copy;
2294
        write_count -= to_copy;
2295
    }
2296
out:
2297
    complete_pdu(s, vs->pdu, err);
2298
    qemu_free(vs);
2299
}
2300

    
2301
static void v9fs_write(V9fsState *s, V9fsPDU *pdu)
2302
{
2303
    int32_t fid;
2304
    V9fsWriteState *vs;
2305
    ssize_t err;
2306

    
2307
    vs = qemu_malloc(sizeof(*vs));
2308

    
2309
    vs->pdu = pdu;
2310
    vs->offset = 7;
2311
    vs->sg = vs->iov;
2312
    vs->total = 0;
2313
    vs->len = 0;
2314

    
2315
    pdu_unmarshal(vs->pdu, vs->offset, "dqdv", &fid, &vs->off, &vs->count,
2316
                  vs->sg, &vs->cnt);
2317

    
2318
    vs->fidp = lookup_fid(s, fid);
2319
    if (vs->fidp == NULL) {
2320
        err = -EINVAL;
2321
        goto out;
2322
    }
2323

    
2324
    if (vs->fidp->fid_type == P9_FID_FILE) {
2325
        if (vs->fidp->fs.fd == -1) {
2326
            err = -EINVAL;
2327
            goto out;
2328
        }
2329
    } else if (vs->fidp->fid_type == P9_FID_XATTR) {
2330
        /*
2331
         * setxattr operation
2332
         */
2333
        v9fs_xattr_write(s, vs);
2334
        return;
2335
    } else {
2336
        err = -EINVAL;
2337
        goto out;
2338
    }
2339
    vs->sg = cap_sg(vs->sg, vs->count, &vs->cnt);
2340
    if (vs->total <= vs->count) {
2341
        vs->len = v9fs_do_pwritev(s, vs->fidp->fs.fd, vs->sg, vs->cnt, vs->off);
2342
        if (vs->len > 0) {
2343
            vs->off += vs->len;
2344
        }
2345
        err = vs->len;
2346
        v9fs_write_post_pwritev(s, vs, err);
2347
    }
2348
    return;
2349
out:
2350
    complete_pdu(s, vs->pdu, err);
2351
    qemu_free(vs);
2352
}
2353

    
2354
static void v9fs_create_post_getiounit(V9fsState *s, V9fsCreateState *vs)
2355
{
2356
    int err;
2357
    v9fs_string_copy(&vs->fidp->path, &vs->fullname);
2358
    stat_to_qid(&vs->stbuf, &vs->qid);
2359

    
2360
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, vs->iounit);
2361
    err = vs->offset;
2362

    
2363
    complete_pdu(s, vs->pdu, err);
2364
    v9fs_string_free(&vs->name);
2365
    v9fs_string_free(&vs->extension);
2366
    v9fs_string_free(&vs->fullname);
2367
    qemu_free(vs);
2368
}
2369

    
2370
static void v9fs_post_create(V9fsState *s, V9fsCreateState *vs, int err)
2371
{
2372
    if (err == 0) {
2373
        vs->iounit = get_iounit(s, &vs->fidp->path);
2374
        v9fs_create_post_getiounit(s, vs);
2375
        return;
2376
    }
2377

    
2378
    complete_pdu(s, vs->pdu, err);
2379
    v9fs_string_free(&vs->name);
2380
    v9fs_string_free(&vs->extension);
2381
    v9fs_string_free(&vs->fullname);
2382
    qemu_free(vs);
2383
}
2384

    
2385
static void v9fs_create_post_perms(V9fsState *s, V9fsCreateState *vs, int err)
2386
{
2387
    if (err) {
2388
        err = -errno;
2389
    }
2390
    v9fs_post_create(s, vs, err);
2391
}
2392

    
2393
static void v9fs_create_post_opendir(V9fsState *s, V9fsCreateState *vs,
2394
                                                                    int err)
2395
{
2396
    if (!vs->fidp->fs.dir) {
2397
        err = -errno;
2398
    }
2399
    vs->fidp->fid_type = P9_FID_DIR;
2400
    v9fs_post_create(s, vs, err);
2401
}
2402

    
2403
static void v9fs_create_post_dir_lstat(V9fsState *s, V9fsCreateState *vs,
2404
                                                                    int err)
2405
{
2406
    if (err) {
2407
        err = -errno;
2408
        goto out;
2409
    }
2410

    
2411
    vs->fidp->fs.dir = v9fs_do_opendir(s, &vs->fullname);
2412
    v9fs_create_post_opendir(s, vs, err);
2413
    return;
2414

    
2415
out:
2416
    v9fs_post_create(s, vs, err);
2417
}
2418

    
2419
static void v9fs_create_post_mkdir(V9fsState *s, V9fsCreateState *vs, int err)
2420
{
2421
    if (err) {
2422
        err = -errno;
2423
        goto out;
2424
    }
2425

    
2426
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2427
    v9fs_create_post_dir_lstat(s, vs, err);
2428
    return;
2429

    
2430
out:
2431
    v9fs_post_create(s, vs, err);
2432
}
2433

    
2434
static void v9fs_create_post_fstat(V9fsState *s, V9fsCreateState *vs, int err)
2435
{
2436
    if (err) {
2437
        vs->fidp->fid_type = P9_FID_NONE;
2438
        close(vs->fidp->fs.fd);
2439
        err = -errno;
2440
    }
2441
    v9fs_post_create(s, vs, err);
2442
    return;
2443
}
2444

    
2445
static void v9fs_create_post_open2(V9fsState *s, V9fsCreateState *vs, int err)
2446
{
2447
    if (vs->fidp->fs.fd == -1) {
2448
        err = -errno;
2449
        goto out;
2450
    }
2451
    vs->fidp->fid_type = P9_FID_FILE;
2452
    err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
2453
    v9fs_create_post_fstat(s, vs, err);
2454

    
2455
    return;
2456

    
2457
out:
2458
    v9fs_post_create(s, vs, err);
2459

    
2460
}
2461

    
2462
static void v9fs_create_post_lstat(V9fsState *s, V9fsCreateState *vs, int err)
2463
{
2464

    
2465
    if (err == 0 || errno != ENOENT) {
2466
        err = -errno;
2467
        goto out;
2468
    }
2469

    
2470
    if (vs->perm & P9_STAT_MODE_DIR) {
2471
        err = v9fs_do_mkdir(s, vs->fullname.data, vs->perm & 0777,
2472
                vs->fidp->uid, -1);
2473
        v9fs_create_post_mkdir(s, vs, err);
2474
    } else if (vs->perm & P9_STAT_MODE_SYMLINK) {
2475
        err = v9fs_do_symlink(s, vs->fidp, vs->extension.data,
2476
                vs->fullname.data, -1);
2477
        v9fs_create_post_perms(s, vs, err);
2478
    } else if (vs->perm & P9_STAT_MODE_LINK) {
2479
        int32_t nfid = atoi(vs->extension.data);
2480
        V9fsFidState *nfidp = lookup_fid(s, nfid);
2481
        if (nfidp == NULL) {
2482
            err = -errno;
2483
            v9fs_post_create(s, vs, err);
2484
        }
2485
        err = v9fs_do_link(s, &nfidp->path, &vs->fullname);
2486
        v9fs_create_post_perms(s, vs, err);
2487
    } else if (vs->perm & P9_STAT_MODE_DEVICE) {
2488
        char ctype;
2489
        uint32_t major, minor;
2490
        mode_t nmode = 0;
2491

    
2492
        if (sscanf(vs->extension.data, "%c %u %u", &ctype, &major,
2493
                                        &minor) != 3) {
2494
            err = -errno;
2495
            v9fs_post_create(s, vs, err);
2496
        }
2497

    
2498
        switch (ctype) {
2499
        case 'c':
2500
            nmode = S_IFCHR;
2501
            break;
2502
        case 'b':
2503
            nmode = S_IFBLK;
2504
            break;
2505
        default:
2506
            err = -EIO;
2507
            v9fs_post_create(s, vs, err);
2508
        }
2509

    
2510
        nmode |= vs->perm & 0777;
2511
        err = v9fs_do_mknod(s, vs->fullname.data, nmode,
2512
                makedev(major, minor), vs->fidp->uid, -1);
2513
        v9fs_create_post_perms(s, vs, err);
2514
    } else if (vs->perm & P9_STAT_MODE_NAMED_PIPE) {
2515
        err = v9fs_do_mknod(s, vs->fullname.data, S_IFIFO | (vs->perm & 0777),
2516
                0, vs->fidp->uid, -1);
2517
        v9fs_post_create(s, vs, err);
2518
    } else if (vs->perm & P9_STAT_MODE_SOCKET) {
2519
        err = v9fs_do_mknod(s, vs->fullname.data, S_IFSOCK | (vs->perm & 0777),
2520
                0, vs->fidp->uid, -1);
2521
        v9fs_post_create(s, vs, err);
2522
    } else {
2523
        vs->fidp->fs.fd = v9fs_do_open2(s, vs->fullname.data, vs->fidp->uid,
2524
                -1, omode_to_uflags(vs->mode)|O_CREAT, vs->perm);
2525

    
2526
        v9fs_create_post_open2(s, vs, err);
2527
    }
2528

    
2529
    return;
2530

    
2531
out:
2532
    v9fs_post_create(s, vs, err);
2533
}
2534

    
2535
static void v9fs_create(V9fsState *s, V9fsPDU *pdu)
2536
{
2537
    int32_t fid;
2538
    V9fsCreateState *vs;
2539
    int err = 0;
2540

    
2541
    vs = qemu_malloc(sizeof(*vs));
2542
    vs->pdu = pdu;
2543
    vs->offset = 7;
2544

    
2545
    v9fs_string_init(&vs->fullname);
2546

    
2547
    pdu_unmarshal(vs->pdu, vs->offset, "dsdbs", &fid, &vs->name,
2548
                                &vs->perm, &vs->mode, &vs->extension);
2549

    
2550
    vs->fidp = lookup_fid(s, fid);
2551
    if (vs->fidp == NULL) {
2552
        err = -EINVAL;
2553
        goto out;
2554
    }
2555

    
2556
    v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->fidp->path.data,
2557
                                                        vs->name.data);
2558

    
2559
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2560
    v9fs_create_post_lstat(s, vs, err);
2561
    return;
2562

    
2563
out:
2564
    complete_pdu(s, vs->pdu, err);
2565
    v9fs_string_free(&vs->name);
2566
    v9fs_string_free(&vs->extension);
2567
    qemu_free(vs);
2568
}
2569

    
2570
static void v9fs_post_symlink(V9fsState *s, V9fsSymlinkState *vs, int err)
2571
{
2572
    if (err == 0) {
2573
        stat_to_qid(&vs->stbuf, &vs->qid);
2574
        vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
2575
        err = vs->offset;
2576
    } else {
2577
        err = -errno;
2578
    }
2579
    complete_pdu(s, vs->pdu, err);
2580
    v9fs_string_free(&vs->name);
2581
    v9fs_string_free(&vs->symname);
2582
    v9fs_string_free(&vs->fullname);
2583
    qemu_free(vs);
2584
}
2585

    
2586
static void v9fs_symlink_post_do_symlink(V9fsState *s, V9fsSymlinkState *vs,
2587
        int err)
2588
{
2589
    if (err) {
2590
        goto out;
2591
    }
2592
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2593
out:
2594
    v9fs_post_symlink(s, vs, err);
2595
}
2596

    
2597
static void v9fs_symlink(V9fsState *s, V9fsPDU *pdu)
2598
{
2599
    int32_t dfid;
2600
    V9fsSymlinkState *vs;
2601
    int err = 0;
2602
    gid_t gid;
2603

    
2604
    vs = qemu_malloc(sizeof(*vs));
2605
    vs->pdu = pdu;
2606
    vs->offset = 7;
2607

    
2608
    v9fs_string_init(&vs->fullname);
2609

    
2610
    pdu_unmarshal(vs->pdu, vs->offset, "dssd", &dfid, &vs->name,
2611
            &vs->symname, &gid);
2612

    
2613
    vs->dfidp = lookup_fid(s, dfid);
2614
    if (vs->dfidp == NULL) {
2615
        err = -EINVAL;
2616
        goto out;
2617
    }
2618

    
2619
    v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->dfidp->path.data,
2620
            vs->name.data);
2621
    err = v9fs_do_symlink(s, vs->dfidp, vs->symname.data,
2622
            vs->fullname.data, gid);
2623
    v9fs_symlink_post_do_symlink(s, vs, err);
2624
    return;
2625

    
2626
out:
2627
    complete_pdu(s, vs->pdu, err);
2628
    v9fs_string_free(&vs->name);
2629
    v9fs_string_free(&vs->symname);
2630
    qemu_free(vs);
2631
}
2632

    
2633
static void v9fs_flush(V9fsState *s, V9fsPDU *pdu)
2634
{
2635
    /* A nop call with no return */
2636
    complete_pdu(s, pdu, 7);
2637
}
2638

    
2639
static void v9fs_link(V9fsState *s, V9fsPDU *pdu)
2640
{
2641
    int32_t dfid, oldfid;
2642
    V9fsFidState *dfidp, *oldfidp;
2643
    V9fsString name, fullname;
2644
    size_t offset = 7;
2645
    int err = 0;
2646

    
2647
    v9fs_string_init(&fullname);
2648

    
2649
    pdu_unmarshal(pdu, offset, "dds", &dfid, &oldfid, &name);
2650

    
2651
    dfidp = lookup_fid(s, dfid);
2652
    if (dfidp == NULL) {
2653
        err = -errno;
2654
        goto out;
2655
    }
2656

    
2657
    oldfidp = lookup_fid(s, oldfid);
2658
    if (oldfidp == NULL) {
2659
        err = -errno;
2660
        goto out;
2661
    }
2662

    
2663
    v9fs_string_sprintf(&fullname, "%s/%s", dfidp->path.data, name.data);
2664
    err = offset;
2665
    err = v9fs_do_link(s, &oldfidp->path, &fullname);
2666
    if (err) {
2667
        err = -errno;
2668
    }
2669
    v9fs_string_free(&fullname);
2670

    
2671
out:
2672
    v9fs_string_free(&name);
2673
    complete_pdu(s, pdu, err);
2674
}
2675

    
2676
static void v9fs_remove_post_remove(V9fsState *s, V9fsRemoveState *vs,
2677
                                                                int err)
2678
{
2679
    if (err < 0) {
2680
        err = -errno;
2681
    } else {
2682
        err = vs->offset;
2683
    }
2684

    
2685
    /* For TREMOVE we need to clunk the fid even on failed remove */
2686
    free_fid(s, vs->fidp->fid);
2687

    
2688
    complete_pdu(s, vs->pdu, err);
2689
    qemu_free(vs);
2690
}
2691

    
2692
static void v9fs_remove(V9fsState *s, V9fsPDU *pdu)
2693
{
2694
    int32_t fid;
2695
    V9fsRemoveState *vs;
2696
    int err = 0;
2697

    
2698
    vs = qemu_malloc(sizeof(*vs));
2699
    vs->pdu = pdu;
2700
    vs->offset = 7;
2701

    
2702
    pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
2703

    
2704
    vs->fidp = lookup_fid(s, fid);
2705
    if (vs->fidp == NULL) {
2706
        err = -EINVAL;
2707
        goto out;
2708
    }
2709

    
2710
    err = v9fs_do_remove(s, &vs->fidp->path);
2711
    v9fs_remove_post_remove(s, vs, err);
2712
    return;
2713

    
2714
out:
2715
    complete_pdu(s, pdu, err);
2716
    qemu_free(vs);
2717
}
2718

    
2719
static void v9fs_wstat_post_truncate(V9fsState *s, V9fsWstatState *vs, int err)
2720
{
2721
    if (err < 0) {
2722
        goto out;
2723
    }
2724

    
2725
    err = vs->offset;
2726

    
2727
out:
2728
    v9fs_stat_free(&vs->v9stat);
2729
    complete_pdu(s, vs->pdu, err);
2730
    qemu_free(vs);
2731
}
2732

    
2733
static void v9fs_wstat_post_rename(V9fsState *s, V9fsWstatState *vs, int err)
2734
{
2735
    if (err < 0) {
2736
        goto out;
2737
    }
2738
    if (vs->v9stat.length != -1) {
2739
        if (v9fs_do_truncate(s, &vs->fidp->path, vs->v9stat.length) < 0) {
2740
            err = -errno;
2741
        }
2742
    }
2743
    v9fs_wstat_post_truncate(s, vs, err);
2744
    return;
2745

    
2746
out:
2747
    v9fs_stat_free(&vs->v9stat);
2748
    complete_pdu(s, vs->pdu, err);
2749
    qemu_free(vs);
2750
}
2751

    
2752
static int v9fs_complete_rename(V9fsState *s, V9fsRenameState *vs)
2753
{
2754
    int err = 0;
2755
    char *old_name, *new_name;
2756
    char *end;
2757

    
2758
    if (vs->newdirfid != -1) {
2759
        V9fsFidState *dirfidp;
2760
        dirfidp = lookup_fid(s, vs->newdirfid);
2761

    
2762
        if (dirfidp == NULL) {
2763
            err = -ENOENT;
2764
            goto out;
2765
        }
2766

    
2767
        BUG_ON(dirfidp->fid_type != P9_FID_NONE);
2768

    
2769
        new_name = qemu_mallocz(dirfidp->path.size + vs->name.size + 2);
2770

    
2771
        strcpy(new_name, dirfidp->path.data);
2772
        strcat(new_name, "/");
2773
        strcat(new_name + dirfidp->path.size, vs->name.data);
2774
    } else {
2775
        old_name = vs->fidp->path.data;
2776
        end = strrchr(old_name, '/');
2777
        if (end) {
2778
            end++;
2779
        } else {
2780
            end = old_name;
2781
        }
2782
        new_name = qemu_mallocz(end - old_name + vs->name.size + 1);
2783

    
2784
        strncat(new_name, old_name, end - old_name);
2785
        strncat(new_name + (end - old_name), vs->name.data, vs->name.size);
2786
    }
2787

    
2788
    v9fs_string_free(&vs->name);
2789
    vs->name.data = qemu_strdup(new_name);
2790
    vs->name.size = strlen(new_name);
2791

    
2792
    if (strcmp(new_name, vs->fidp->path.data) != 0) {
2793
        if (v9fs_do_rename(s, &vs->fidp->path, &vs->name)) {
2794
            err = -errno;
2795
        } else {
2796
            V9fsFidState *fidp;
2797
            /*
2798
            * Fixup fid's pointing to the old name to
2799
            * start pointing to the new name
2800
            */
2801
            for (fidp = s->fid_list; fidp; fidp = fidp->next) {
2802
                if (vs->fidp == fidp) {
2803
                    /*
2804
                    * we replace name of this fid towards the end
2805
                    * so that our below strcmp will work
2806
                    */
2807
                    continue;
2808
                }
2809
                if (!strncmp(vs->fidp->path.data, fidp->path.data,
2810
                    strlen(vs->fidp->path.data))) {
2811
                    /* replace the name */
2812
                    v9fs_fix_path(&fidp->path, &vs->name,
2813
                                  strlen(vs->fidp->path.data));
2814
                }
2815
            }
2816
            v9fs_string_copy(&vs->fidp->path, &vs->name);
2817
        }
2818
    }
2819
out:
2820
    v9fs_string_free(&vs->name);
2821
    return err;
2822
}
2823

    
2824
static void v9fs_rename_post_rename(V9fsState *s, V9fsRenameState *vs, int err)
2825
{
2826
    complete_pdu(s, vs->pdu, err);
2827
    qemu_free(vs);
2828
}
2829

    
2830
static void v9fs_wstat_post_chown(V9fsState *s, V9fsWstatState *vs, int err)
2831
{
2832
    if (err < 0) {
2833
        goto out;
2834
    }
2835

    
2836
    if (vs->v9stat.name.size != 0) {
2837
        V9fsRenameState *vr;
2838

    
2839
        vr = qemu_mallocz(sizeof(V9fsRenameState));
2840
        vr->newdirfid = -1;
2841
        vr->pdu = vs->pdu;
2842
        vr->fidp = vs->fidp;
2843
        vr->offset = vs->offset;
2844
        vr->name.size = vs->v9stat.name.size;
2845
        vr->name.data = qemu_strdup(vs->v9stat.name.data);
2846

    
2847
        err = v9fs_complete_rename(s, vr);
2848
        qemu_free(vr);
2849
    }
2850
    v9fs_wstat_post_rename(s, vs, err);
2851
    return;
2852

    
2853
out:
2854
    v9fs_stat_free(&vs->v9stat);
2855
    complete_pdu(s, vs->pdu, err);
2856
    qemu_free(vs);
2857
}
2858

    
2859
static void v9fs_rename(V9fsState *s, V9fsPDU *pdu)
2860
{
2861
    int32_t fid;
2862
    V9fsRenameState *vs;
2863
    ssize_t err = 0;
2864

    
2865
    vs = qemu_malloc(sizeof(*vs));
2866
    vs->pdu = pdu;
2867
    vs->offset = 7;
2868

    
2869
    pdu_unmarshal(vs->pdu, vs->offset, "dds", &fid, &vs->newdirfid, &vs->name);
2870

    
2871
    vs->fidp = lookup_fid(s, fid);
2872
    if (vs->fidp == NULL) {
2873
        err = -ENOENT;
2874
        goto out;
2875
    }
2876

    
2877
    BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
2878

    
2879
    err = v9fs_complete_rename(s, vs);
2880
    v9fs_rename_post_rename(s, vs, err);
2881
    return;
2882
out:
2883
    complete_pdu(s, vs->pdu, err);
2884
    qemu_free(vs);
2885
}
2886

    
2887
static void v9fs_wstat_post_utime(V9fsState *s, V9fsWstatState *vs, int err)
2888
{
2889
    if (err < 0) {
2890
        goto out;
2891
    }
2892

    
2893
    if (vs->v9stat.n_gid != -1 || vs->v9stat.n_uid != -1) {
2894
        if (v9fs_do_chown(s, &vs->fidp->path, vs->v9stat.n_uid,
2895
                    vs->v9stat.n_gid)) {
2896
            err = -errno;
2897
        }
2898
    }
2899
    v9fs_wstat_post_chown(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_post_chmod(V9fsState *s, V9fsWstatState *vs, int err)
2909
{
2910
    if (err < 0) {
2911
        goto out;
2912
    }
2913

    
2914
    if (vs->v9stat.mtime != -1 || vs->v9stat.atime != -1) {
2915
        struct timespec times[2];
2916
        if (vs->v9stat.atime != -1) {
2917
            times[0].tv_sec = vs->v9stat.atime;
2918
            times[0].tv_nsec = 0;
2919
        } else {
2920
            times[0].tv_nsec = UTIME_OMIT;
2921
        }
2922
        if (vs->v9stat.mtime != -1) {
2923
            times[1].tv_sec = vs->v9stat.mtime;
2924
            times[1].tv_nsec = 0;
2925
        } else {
2926
            times[1].tv_nsec = UTIME_OMIT;
2927
        }
2928

    
2929
        if (v9fs_do_utimensat(s, &vs->fidp->path, times)) {
2930
            err = -errno;
2931
        }
2932
    }
2933

    
2934
    v9fs_wstat_post_utime(s, vs, err);
2935
    return;
2936

    
2937
out:
2938
    v9fs_stat_free(&vs->v9stat);
2939
    complete_pdu(s, vs->pdu, err);
2940
    qemu_free(vs);
2941
}
2942

    
2943
static void v9fs_wstat_post_fsync(V9fsState *s, V9fsWstatState *vs, int err)
2944
{
2945
    if (err == -1) {
2946
        err = -errno;
2947
    }
2948
    v9fs_stat_free(&vs->v9stat);
2949
    complete_pdu(s, vs->pdu, err);
2950
    qemu_free(vs);
2951
}
2952

    
2953
static void v9fs_wstat_post_lstat(V9fsState *s, V9fsWstatState *vs, int err)
2954
{
2955
    uint32_t v9_mode;
2956

    
2957
    if (err == -1) {
2958
        err = -errno;
2959
        goto out;
2960
    }
2961

    
2962
    v9_mode = stat_to_v9mode(&vs->stbuf);
2963

    
2964
    if ((vs->v9stat.mode & P9_STAT_MODE_TYPE_BITS) !=
2965
        (v9_mode & P9_STAT_MODE_TYPE_BITS)) {
2966
            /* Attempting to change the type */
2967
            err = -EIO;
2968
            goto out;
2969
    }
2970

    
2971
    if (v9fs_do_chmod(s, &vs->fidp->path, v9mode_to_mode(vs->v9stat.mode,
2972
                    &vs->v9stat.extension))) {
2973
            err = -errno;
2974
     }
2975
    v9fs_wstat_post_chmod(s, vs, err);
2976
    return;
2977

    
2978
out:
2979
    v9fs_stat_free(&vs->v9stat);
2980
    complete_pdu(s, vs->pdu, err);
2981
    qemu_free(vs);
2982
}
2983

    
2984
static void v9fs_wstat(V9fsState *s, V9fsPDU *pdu)
2985
{
2986
    int32_t fid;
2987
    V9fsWstatState *vs;
2988
    int err = 0;
2989

    
2990
    vs = qemu_malloc(sizeof(*vs));
2991
    vs->pdu = pdu;
2992
    vs->offset = 7;
2993

    
2994
    pdu_unmarshal(pdu, vs->offset, "dwS", &fid, &vs->unused, &vs->v9stat);
2995

    
2996
    vs->fidp = lookup_fid(s, fid);
2997
    if (vs->fidp == NULL) {
2998
        err = -EINVAL;
2999
        goto out;
3000
    }
3001

    
3002
    /* do we need to sync the file? */
3003
    if (donttouch_stat(&vs->v9stat)) {
3004
        err = v9fs_do_fsync(s, vs->fidp->fs.fd);
3005
        v9fs_wstat_post_fsync(s, vs, err);
3006
        return;
3007
    }
3008

    
3009
    if (vs->v9stat.mode != -1) {
3010
        err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
3011
        v9fs_wstat_post_lstat(s, vs, err);
3012
        return;
3013
    }
3014

    
3015
    v9fs_wstat_post_chmod(s, vs, err);
3016
    return;
3017

    
3018
out:
3019
    v9fs_stat_free(&vs->v9stat);
3020
    complete_pdu(s, vs->pdu, err);
3021
    qemu_free(vs);
3022
}
3023

    
3024
static void v9fs_statfs_post_statfs(V9fsState *s, V9fsStatfsState *vs, int err)
3025
{
3026
    int32_t bsize_factor;
3027

    
3028
    if (err) {
3029
        err = -errno;
3030
        goto out;
3031
    }
3032

    
3033
    /*
3034
     * compute bsize factor based on host file system block size
3035
     * and client msize
3036
     */
3037
    bsize_factor = (s->msize - P9_IOHDRSZ)/vs->stbuf.f_bsize;
3038
    if (!bsize_factor) {
3039
        bsize_factor = 1;
3040
    }
3041
    vs->v9statfs.f_type = vs->stbuf.f_type;
3042
    vs->v9statfs.f_bsize = vs->stbuf.f_bsize;
3043
    vs->v9statfs.f_bsize *= bsize_factor;
3044
    /*
3045
     * f_bsize is adjusted(multiplied) by bsize factor, so we need to
3046
     * adjust(divide) the number of blocks, free blocks and available
3047
     * blocks by bsize factor
3048
     */
3049
    vs->v9statfs.f_blocks = vs->stbuf.f_blocks/bsize_factor;
3050
    vs->v9statfs.f_bfree = vs->stbuf.f_bfree/bsize_factor;
3051
    vs->v9statfs.f_bavail = vs->stbuf.f_bavail/bsize_factor;
3052
    vs->v9statfs.f_files = vs->stbuf.f_files;
3053
    vs->v9statfs.f_ffree = vs->stbuf.f_ffree;
3054
    vs->v9statfs.fsid_val = (unsigned int) vs->stbuf.f_fsid.__val[0] |
3055
                        (unsigned long long)vs->stbuf.f_fsid.__val[1] << 32;
3056
    vs->v9statfs.f_namelen = vs->stbuf.f_namelen;
3057

    
3058
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "ddqqqqqqd",
3059
         vs->v9statfs.f_type, vs->v9statfs.f_bsize, vs->v9statfs.f_blocks,
3060
         vs->v9statfs.f_bfree, vs->v9statfs.f_bavail, vs->v9statfs.f_files,
3061
         vs->v9statfs.f_ffree, vs->v9statfs.fsid_val,
3062
         vs->v9statfs.f_namelen);
3063

    
3064
out:
3065
    complete_pdu(s, vs->pdu, vs->offset);
3066
    qemu_free(vs);
3067
}
3068

    
3069
static void v9fs_statfs(V9fsState *s, V9fsPDU *pdu)
3070
{
3071
    V9fsStatfsState *vs;
3072
    ssize_t err = 0;
3073

    
3074
    vs = qemu_malloc(sizeof(*vs));
3075
    vs->pdu = pdu;
3076
    vs->offset = 7;
3077

    
3078
    memset(&vs->v9statfs, 0, sizeof(vs->v9statfs));
3079

    
3080
    pdu_unmarshal(vs->pdu, vs->offset, "d", &vs->fid);
3081

    
3082
    vs->fidp = lookup_fid(s, vs->fid);
3083
    if (vs->fidp == NULL) {
3084
        err = -ENOENT;
3085
        goto out;
3086
    }
3087

    
3088
    err = v9fs_do_statfs(s, &vs->fidp->path, &vs->stbuf);
3089
    v9fs_statfs_post_statfs(s, vs, err);
3090
    return;
3091

    
3092
out:
3093
    complete_pdu(s, vs->pdu, err);
3094
    qemu_free(vs);
3095
}
3096

    
3097
static void v9fs_mknod_post_lstat(V9fsState *s, V9fsMkState *vs, int err)
3098
{
3099
    if (err == -1) {
3100
        err = -errno;
3101
        goto out;
3102
    }
3103

    
3104
    stat_to_qid(&vs->stbuf, &vs->qid);
3105
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
3106
    err = vs->offset;
3107
out:
3108
    complete_pdu(s, vs->pdu, err);
3109
    v9fs_string_free(&vs->fullname);
3110
    v9fs_string_free(&vs->name);
3111
    qemu_free(vs);
3112
}
3113

    
3114
static void v9fs_mknod_post_mknod(V9fsState *s, V9fsMkState *vs, int err)
3115
{
3116
    if (err == -1) {
3117
        err = -errno;
3118
        goto out;
3119
    }
3120

    
3121
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
3122
    v9fs_mknod_post_lstat(s, vs, err);
3123
    return;
3124
out:
3125
    complete_pdu(s, vs->pdu, err);
3126
    v9fs_string_free(&vs->fullname);
3127
    v9fs_string_free(&vs->name);
3128
    qemu_free(vs);
3129
}
3130

    
3131
static void v9fs_mknod(V9fsState *s, V9fsPDU *pdu)
3132
{
3133
    int32_t fid;
3134
    V9fsMkState *vs;
3135
    int err = 0;
3136
    V9fsFidState *fidp;
3137
    gid_t gid;
3138
    int mode;
3139
    int major, minor;
3140

    
3141
    vs = qemu_malloc(sizeof(*vs));
3142
    vs->pdu = pdu;
3143
    vs->offset = 7;
3144

    
3145
    v9fs_string_init(&vs->fullname);
3146
    pdu_unmarshal(vs->pdu, vs->offset, "dsdddd", &fid, &vs->name, &mode,
3147
        &major, &minor, &gid);
3148

    
3149
    fidp = lookup_fid(s, fid);
3150
    if (fidp == NULL) {
3151
        err = -ENOENT;
3152
        goto out;
3153
    }
3154

    
3155
    v9fs_string_sprintf(&vs->fullname, "%s/%s", fidp->path.data, vs->name.data);
3156
    err = v9fs_do_mknod(s, vs->fullname.data, mode, makedev(major, minor),
3157
        fidp->uid, gid);
3158
    v9fs_mknod_post_mknod(s, vs, err);
3159
    return;
3160

    
3161
out:
3162
    complete_pdu(s, vs->pdu, err);
3163
    v9fs_string_free(&vs->fullname);
3164
    v9fs_string_free(&vs->name);
3165
    qemu_free(vs);
3166
}
3167

    
3168
/*
3169
 * Implement posix byte range locking code
3170
 * Server side handling of locking code is very simple, because 9p server in
3171
 * QEMU can handle only one client. And most of the lock handling
3172
 * (like conflict, merging) etc is done by the VFS layer itself, so no need to
3173
 * do any thing in * qemu 9p server side lock code path.
3174
 * So when a TLOCK request comes, always return success
3175
 */
3176

    
3177
static void v9fs_lock(V9fsState *s, V9fsPDU *pdu)
3178
{
3179
    int32_t fid, err = 0;
3180
    V9fsLockState *vs;
3181

    
3182
    vs = qemu_mallocz(sizeof(*vs));
3183
    vs->pdu = pdu;
3184
    vs->offset = 7;
3185

    
3186
    vs->flock = qemu_malloc(sizeof(*vs->flock));
3187
    pdu_unmarshal(vs->pdu, vs->offset, "dbdqqds", &fid, &vs->flock->type,
3188
                &vs->flock->flags, &vs->flock->start, &vs->flock->length,
3189
                            &vs->flock->proc_id, &vs->flock->client_id);
3190

    
3191
    vs->status = P9_LOCK_ERROR;
3192

    
3193
    /* We support only block flag now (that too ignored currently) */
3194
    if (vs->flock->flags & ~P9_LOCK_FLAGS_BLOCK) {
3195
        err = -EINVAL;
3196
        goto out;
3197
    }
3198
    vs->fidp = lookup_fid(s, fid);
3199
    if (vs->fidp == NULL) {
3200
        err = -ENOENT;
3201
        goto out;
3202
    }
3203

    
3204
    err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
3205
    if (err < 0) {
3206
        err = -errno;
3207
        goto out;
3208
    }
3209
    vs->status = P9_LOCK_SUCCESS;
3210
out:
3211
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "b", vs->status);
3212
    complete_pdu(s, vs->pdu, err);
3213
    qemu_free(vs->flock);
3214
    qemu_free(vs);
3215
}
3216

    
3217
/*
3218
 * When a TGETLOCK request comes, always return success because all lock
3219
 * handling is done by client's VFS layer.
3220
 */
3221

    
3222
static void v9fs_getlock(V9fsState *s, V9fsPDU *pdu)
3223
{
3224
    int32_t fid, err = 0;
3225
    V9fsGetlockState *vs;
3226

    
3227
    vs = qemu_mallocz(sizeof(*vs));
3228
    vs->pdu = pdu;
3229
    vs->offset = 7;
3230

    
3231
    vs->glock = qemu_malloc(sizeof(*vs->glock));
3232
    pdu_unmarshal(vs->pdu, vs->offset, "dbqqds", &fid, &vs->glock->type,
3233
                &vs->glock->start, &vs->glock->length, &vs->glock->proc_id,
3234
                &vs->glock->client_id);
3235

    
3236
    vs->fidp = lookup_fid(s, fid);
3237
    if (vs->fidp == NULL) {
3238
        err = -ENOENT;
3239
        goto out;
3240
    }
3241

    
3242
    err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
3243
    if (err < 0) {
3244
        err = -errno;
3245
        goto out;
3246
    }
3247
    vs->glock->type = F_UNLCK;
3248
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "bqqds", vs->glock->type,
3249
                vs->glock->start, vs->glock->length, vs->glock->proc_id,
3250
                &vs->glock->client_id);
3251
out:
3252
    complete_pdu(s, vs->pdu, err);
3253
    qemu_free(vs->glock);
3254
    qemu_free(vs);
3255
}
3256

    
3257
static void v9fs_mkdir_post_lstat(V9fsState *s, V9fsMkState *vs, int err)
3258
{
3259
    if (err == -1) {
3260
        err = -errno;
3261
        goto out;
3262
    }
3263

    
3264
    stat_to_qid(&vs->stbuf, &vs->qid);
3265
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
3266
    err = vs->offset;
3267
out:
3268
    complete_pdu(s, vs->pdu, err);
3269
    v9fs_string_free(&vs->fullname);
3270
    v9fs_string_free(&vs->name);
3271
    qemu_free(vs);
3272
}
3273

    
3274
static void v9fs_mkdir_post_mkdir(V9fsState *s, V9fsMkState *vs, int err)
3275
{
3276
    if (err == -1) {
3277
        err = -errno;
3278
        goto out;
3279
    }
3280

    
3281
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
3282
    v9fs_mkdir_post_lstat(s, vs, err);
3283
    return;
3284
out:
3285
    complete_pdu(s, vs->pdu, err);
3286
    v9fs_string_free(&vs->fullname);
3287
    v9fs_string_free(&vs->name);
3288
    qemu_free(vs);
3289
}
3290

    
3291
static void v9fs_mkdir(V9fsState *s, V9fsPDU *pdu)
3292
{
3293
    int32_t fid;
3294
    V9fsMkState *vs;
3295
    int err = 0;
3296
    V9fsFidState *fidp;
3297
    gid_t gid;
3298
    int mode;
3299

    
3300
    vs = qemu_malloc(sizeof(*vs));
3301
    vs->pdu = pdu;
3302
    vs->offset = 7;
3303

    
3304
    v9fs_string_init(&vs->fullname);
3305
    pdu_unmarshal(vs->pdu, vs->offset, "dsdd", &fid, &vs->name, &mode,
3306
        &gid);
3307

    
3308
    fidp = lookup_fid(s, fid);
3309
    if (fidp == NULL) {
3310
        err = -ENOENT;
3311
        goto out;
3312
    }
3313

    
3314
    v9fs_string_sprintf(&vs->fullname, "%s/%s", fidp->path.data, vs->name.data);
3315
    err = v9fs_do_mkdir(s, vs->fullname.data, mode, fidp->uid, gid);
3316
    v9fs_mkdir_post_mkdir(s, vs, err);
3317
    return;
3318

    
3319
out:
3320
    complete_pdu(s, vs->pdu, err);
3321
    v9fs_string_free(&vs->fullname);
3322
    v9fs_string_free(&vs->name);
3323
    qemu_free(vs);
3324
}
3325

    
3326
static void v9fs_post_xattr_getvalue(V9fsState *s, V9fsXattrState *vs, int err)
3327
{
3328

    
3329
    if (err < 0) {
3330
        err = -errno;
3331
        free_fid(s, vs->xattr_fidp->fid);
3332
        goto out;
3333
    }
3334
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "q", vs->size);
3335
    err = vs->offset;
3336
out:
3337
    complete_pdu(s, vs->pdu, err);
3338
    v9fs_string_free(&vs->name);
3339
    qemu_free(vs);
3340
    return;
3341
}
3342

    
3343
static void v9fs_post_xattr_check(V9fsState *s, V9fsXattrState *vs, ssize_t err)
3344
{
3345
    if (err < 0) {
3346
        err = -errno;
3347
        free_fid(s, vs->xattr_fidp->fid);
3348
        goto out;
3349
    }
3350
    /*
3351
     * Read the xattr value
3352
     */
3353
    vs->xattr_fidp->fs.xattr.len = vs->size;
3354
    vs->xattr_fidp->fid_type = P9_FID_XATTR;
3355
    vs->xattr_fidp->fs.xattr.copied_len = -1;
3356
    if (vs->size) {
3357
        vs->xattr_fidp->fs.xattr.value = qemu_malloc(vs->size);
3358
        err = v9fs_do_lgetxattr(s, &vs->xattr_fidp->path,
3359
                                &vs->name, vs->xattr_fidp->fs.xattr.value,
3360
                                vs->xattr_fidp->fs.xattr.len);
3361
    }
3362
    v9fs_post_xattr_getvalue(s, vs, err);
3363
    return;
3364
out:
3365
    complete_pdu(s, vs->pdu, err);
3366
    v9fs_string_free(&vs->name);
3367
    qemu_free(vs);
3368
}
3369

    
3370
static void v9fs_post_lxattr_getvalue(V9fsState *s,
3371
                                      V9fsXattrState *vs, int err)
3372
{
3373
    if (err < 0) {
3374
        err = -errno;
3375
        free_fid(s, vs->xattr_fidp->fid);
3376
        goto out;
3377
    }
3378
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "q", vs->size);
3379
    err = vs->offset;
3380
out:
3381
    complete_pdu(s, vs->pdu, err);
3382
    v9fs_string_free(&vs->name);
3383
    qemu_free(vs);
3384
    return;
3385
}
3386

    
3387
static void v9fs_post_lxattr_check(V9fsState *s,
3388
                                   V9fsXattrState *vs, ssize_t err)
3389
{
3390
    if (err < 0) {
3391
        err = -errno;
3392
        free_fid(s, vs->xattr_fidp->fid);
3393
        goto out;
3394
    }
3395
    /*
3396
     * Read the xattr value
3397
     */
3398
    vs->xattr_fidp->fs.xattr.len = vs->size;
3399
    vs->xattr_fidp->fid_type = P9_FID_XATTR;
3400
    vs->xattr_fidp->fs.xattr.copied_len = -1;
3401
    if (vs->size) {
3402
        vs->xattr_fidp->fs.xattr.value = qemu_malloc(vs->size);
3403
        err = v9fs_do_llistxattr(s, &vs->xattr_fidp->path,
3404
                                 vs->xattr_fidp->fs.xattr.value,
3405
                                 vs->xattr_fidp->fs.xattr.len);
3406
    }
3407
    v9fs_post_lxattr_getvalue(s, vs, err);
3408
    return;
3409
out:
3410
    complete_pdu(s, vs->pdu, err);
3411
    v9fs_string_free(&vs->name);
3412
    qemu_free(vs);
3413
}
3414

    
3415
static void v9fs_xattrwalk(V9fsState *s, V9fsPDU *pdu)
3416
{
3417
    ssize_t err = 0;
3418
    V9fsXattrState *vs;
3419
    int32_t fid, newfid;
3420

    
3421
    vs = qemu_malloc(sizeof(*vs));
3422
    vs->pdu = pdu;
3423
    vs->offset = 7;
3424

    
3425
    pdu_unmarshal(vs->pdu, vs->offset, "dds", &fid, &newfid, &vs->name);
3426
    vs->file_fidp = lookup_fid(s, fid);
3427
    if (vs->file_fidp == NULL) {
3428
        err = -ENOENT;
3429
        goto out;
3430
    }
3431

    
3432
    vs->xattr_fidp = alloc_fid(s, newfid);
3433
    if (vs->xattr_fidp == NULL) {
3434
        err = -EINVAL;
3435
        goto out;
3436
    }
3437

    
3438
    v9fs_string_copy(&vs->xattr_fidp->path, &vs->file_fidp->path);
3439
    if (vs->name.data[0] == 0) {
3440
        /*
3441
         * listxattr request. Get the size first
3442
         */
3443
        vs->size = v9fs_do_llistxattr(s, &vs->xattr_fidp->path,
3444
                                      NULL, 0);
3445
        if (vs->size < 0) {
3446
            err = vs->size;
3447
        }
3448
        v9fs_post_lxattr_check(s, vs, err);
3449
        return;
3450
    } else {
3451
        /*
3452
         * specific xattr fid. We check for xattr
3453
         * presence also collect the xattr size
3454
         */
3455
        vs->size = v9fs_do_lgetxattr(s, &vs->xattr_fidp->path,
3456
                                     &vs->name, NULL, 0);
3457
        if (vs->size < 0) {
3458
            err = vs->size;
3459
        }
3460
        v9fs_post_xattr_check(s, vs, err);
3461
        return;
3462
    }
3463
out:
3464
    complete_pdu(s, vs->pdu, err);
3465
    v9fs_string_free(&vs->name);
3466
    qemu_free(vs);
3467
}
3468

    
3469
static void v9fs_xattrcreate(V9fsState *s, V9fsPDU *pdu)
3470
{
3471
    int flags;
3472
    int32_t fid;
3473
    ssize_t err = 0;
3474
    V9fsXattrState *vs;
3475

    
3476
    vs = qemu_malloc(sizeof(*vs));
3477
    vs->pdu = pdu;
3478
    vs->offset = 7;
3479

    
3480
    pdu_unmarshal(vs->pdu, vs->offset, "dsqd",
3481
                  &fid, &vs->name, &vs->size, &flags);
3482

    
3483
    vs->file_fidp = lookup_fid(s, fid);
3484
    if (vs->file_fidp == NULL) {
3485
        err = -EINVAL;
3486
        goto out;
3487
    }
3488

    
3489
    /* Make the file fid point to xattr */
3490
    vs->xattr_fidp = vs->file_fidp;
3491
    vs->xattr_fidp->fid_type = P9_FID_XATTR;
3492
    vs->xattr_fidp->fs.xattr.copied_len = 0;
3493
    vs->xattr_fidp->fs.xattr.len = vs->size;
3494
    vs->xattr_fidp->fs.xattr.flags = flags;
3495
    v9fs_string_init(&vs->xattr_fidp->fs.xattr.name);
3496
    v9fs_string_copy(&vs->xattr_fidp->fs.xattr.name, &vs->name);
3497
    if (vs->size)
3498
        vs->xattr_fidp->fs.xattr.value = qemu_malloc(vs->size);
3499
    else
3500
        vs->xattr_fidp->fs.xattr.value = NULL;
3501

    
3502
out:
3503
    complete_pdu(s, vs->pdu, err);
3504
    v9fs_string_free(&vs->name);
3505
    qemu_free(vs);
3506
}
3507

    
3508
static void v9fs_readlink_post_readlink(V9fsState *s, V9fsReadLinkState *vs,
3509
                                                    int err)
3510
{
3511
    if (err < 0) {
3512
        err = -errno;
3513
        goto out;
3514
    }
3515
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "s", &vs->target);
3516
    err = vs->offset;
3517
out:
3518
    complete_pdu(s, vs->pdu, err);
3519
    v9fs_string_free(&vs->target);
3520
    qemu_free(vs);
3521
}
3522

    
3523
static void v9fs_readlink(V9fsState *s, V9fsPDU *pdu)
3524
{
3525
    int32_t fid;
3526
    V9fsReadLinkState *vs;
3527
    int err = 0;
3528
    V9fsFidState *fidp;
3529

    
3530
    vs = qemu_malloc(sizeof(*vs));
3531
    vs->pdu = pdu;
3532
    vs->offset = 7;
3533

    
3534
    pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
3535

    
3536
    fidp = lookup_fid(s, fid);
3537
    if (fidp == NULL) {
3538
        err = -ENOENT;
3539
        goto out;
3540
    }
3541

    
3542
    v9fs_string_init(&vs->target);
3543
    err = v9fs_do_readlink(s, &fidp->path, &vs->target);
3544
    v9fs_readlink_post_readlink(s, vs, err);
3545
    return;
3546
out:
3547
    complete_pdu(s, vs->pdu, err);
3548
    qemu_free(vs);
3549
}
3550

    
3551
typedef void (pdu_handler_t)(V9fsState *s, V9fsPDU *pdu);
3552

    
3553
static pdu_handler_t *pdu_handlers[] = {
3554
    [P9_TREADDIR] = v9fs_readdir,
3555
    [P9_TSTATFS] = v9fs_statfs,
3556
    [P9_TGETATTR] = v9fs_getattr,
3557
    [P9_TSETATTR] = v9fs_setattr,
3558
    [P9_TXATTRWALK] = v9fs_xattrwalk,
3559
    [P9_TXATTRCREATE] = v9fs_xattrcreate,
3560
    [P9_TMKNOD] = v9fs_mknod,
3561
    [P9_TRENAME] = v9fs_rename,
3562
    [P9_TLOCK] = v9fs_lock,
3563
    [P9_TGETLOCK] = v9fs_getlock,
3564
    [P9_TREADLINK] = v9fs_readlink,
3565
    [P9_TMKDIR] = v9fs_mkdir,
3566
    [P9_TVERSION] = v9fs_version,
3567
    [P9_TLOPEN] = v9fs_open,
3568
    [P9_TATTACH] = v9fs_attach,
3569
    [P9_TSTAT] = v9fs_stat,
3570
    [P9_TWALK] = v9fs_walk,
3571
    [P9_TCLUNK] = v9fs_clunk,
3572
    [P9_TFSYNC] = v9fs_fsync,
3573
    [P9_TOPEN] = v9fs_open,
3574
    [P9_TREAD] = v9fs_read,
3575
#if 0
3576
    [P9_TAUTH] = v9fs_auth,
3577
#endif
3578
    [P9_TFLUSH] = v9fs_flush,
3579
    [P9_TLINK] = v9fs_link,
3580
    [P9_TSYMLINK] = v9fs_symlink,
3581
    [P9_TCREATE] = v9fs_create,
3582
    [P9_TLCREATE] = v9fs_lcreate,
3583
    [P9_TWRITE] = v9fs_write,
3584
    [P9_TWSTAT] = v9fs_wstat,
3585
    [P9_TREMOVE] = v9fs_remove,
3586
};
3587

    
3588
static void submit_pdu(V9fsState *s, V9fsPDU *pdu)
3589
{
3590
    pdu_handler_t *handler;
3591

    
3592
    if (debug_9p_pdu) {
3593
        pprint_pdu(pdu);
3594
    }
3595

    
3596
    BUG_ON(pdu->id >= ARRAY_SIZE(pdu_handlers));
3597

    
3598
    handler = pdu_handlers[pdu->id];
3599
    BUG_ON(handler == NULL);
3600

    
3601
    handler(s, pdu);
3602
}
3603

    
3604
static void handle_9p_output(VirtIODevice *vdev, VirtQueue *vq)
3605
{
3606
    V9fsState *s = (V9fsState *)vdev;
3607
    V9fsPDU *pdu;
3608
    ssize_t len;
3609

    
3610
    while ((pdu = alloc_pdu(s)) &&
3611
            (len = virtqueue_pop(vq, &pdu->elem)) != 0) {
3612
        uint8_t *ptr;
3613

    
3614
        BUG_ON(pdu->elem.out_num == 0 || pdu->elem.in_num == 0);
3615
        BUG_ON(pdu->elem.out_sg[0].iov_len < 7);
3616

    
3617
        ptr = pdu->elem.out_sg[0].iov_base;
3618

    
3619
        memcpy(&pdu->size, ptr, 4);
3620
        pdu->id = ptr[4];
3621
        memcpy(&pdu->tag, ptr + 5, 2);
3622

    
3623
        submit_pdu(s, pdu);
3624
    }
3625

    
3626
    free_pdu(s, pdu);
3627
}
3628

    
3629
static uint32_t virtio_9p_get_features(VirtIODevice *vdev, uint32_t features)
3630
{
3631
    features |= 1 << VIRTIO_9P_MOUNT_TAG;
3632
    return features;
3633
}
3634

    
3635
static V9fsState *to_virtio_9p(VirtIODevice *vdev)
3636
{
3637
    return (V9fsState *)vdev;
3638
}
3639

    
3640
static void virtio_9p_get_config(VirtIODevice *vdev, uint8_t *config)
3641
{
3642
    struct virtio_9p_config *cfg;
3643
    V9fsState *s = to_virtio_9p(vdev);
3644

    
3645
    cfg = qemu_mallocz(sizeof(struct virtio_9p_config) +
3646
                        s->tag_len);
3647
    stw_raw(&cfg->tag_len, s->tag_len);
3648
    memcpy(cfg->tag, s->tag, s->tag_len);
3649
    memcpy(config, cfg, s->config_size);
3650
    qemu_free(cfg);
3651
}
3652

    
3653
VirtIODevice *virtio_9p_init(DeviceState *dev, V9fsConf *conf)
3654
 {
3655
    V9fsState *s;
3656
    int i, len;
3657
    struct stat stat;
3658
    FsTypeEntry *fse;
3659

    
3660

    
3661
    s = (V9fsState *)virtio_common_init("virtio-9p",
3662
                                    VIRTIO_ID_9P,
3663
                                    sizeof(struct virtio_9p_config)+
3664
                                    MAX_TAG_LEN,
3665
                                    sizeof(V9fsState));
3666

    
3667
    /* initialize pdu allocator */
3668
    QLIST_INIT(&s->free_list);
3669
    for (i = 0; i < (MAX_REQ - 1); i++) {
3670
        QLIST_INSERT_HEAD(&s->free_list, &s->pdus[i], next);
3671
    }
3672

    
3673
    s->vq = virtio_add_queue(&s->vdev, MAX_REQ, handle_9p_output);
3674

    
3675
    fse = get_fsdev_fsentry(conf->fsdev_id);
3676

    
3677
    if (!fse) {
3678
        /* We don't have a fsdev identified by fsdev_id */
3679
        fprintf(stderr, "Virtio-9p device couldn't find fsdev with the "
3680
                "id = %s\n", conf->fsdev_id ? conf->fsdev_id : "NULL");
3681
        exit(1);
3682
    }
3683

    
3684
    if (!fse->path || !conf->tag) {
3685
        /* we haven't specified a mount_tag or the path */
3686
        fprintf(stderr, "fsdev with id %s needs path "
3687
                "and Virtio-9p device needs mount_tag arguments\n",
3688
                conf->fsdev_id);
3689
        exit(1);
3690
    }
3691

    
3692
    if (!strcmp(fse->security_model, "passthrough")) {
3693
        /* Files on the Fileserver set to client user credentials */
3694
        s->ctx.fs_sm = SM_PASSTHROUGH;
3695
        s->ctx.xops = passthrough_xattr_ops;
3696
    } else if (!strcmp(fse->security_model, "mapped")) {
3697
        /* Files on the fileserver are set to QEMU credentials.
3698
         * Client user credentials are saved in extended attributes.
3699
         */
3700
        s->ctx.fs_sm = SM_MAPPED;
3701
        s->ctx.xops = mapped_xattr_ops;
3702
    } else if (!strcmp(fse->security_model, "none")) {
3703
        /*
3704
         * Files on the fileserver are set to QEMU credentials.
3705
         */
3706
        s->ctx.fs_sm = SM_NONE;
3707
        s->ctx.xops = none_xattr_ops;
3708
    } else {
3709
        fprintf(stderr, "Default to security_model=none. You may want"
3710
                " enable advanced security model using "
3711
                "security option:\n\t security_model=passthrough \n\t "
3712
                "security_model=mapped\n");
3713
        s->ctx.fs_sm = SM_NONE;
3714
        s->ctx.xops = none_xattr_ops;
3715
    }
3716

    
3717
    if (lstat(fse->path, &stat)) {
3718
        fprintf(stderr, "share path %s does not exist\n", fse->path);
3719
        exit(1);
3720
    } else if (!S_ISDIR(stat.st_mode)) {
3721
        fprintf(stderr, "share path %s is not a directory \n", fse->path);
3722
        exit(1);
3723
    }
3724

    
3725
    s->ctx.fs_root = qemu_strdup(fse->path);
3726
    len = strlen(conf->tag);
3727
    if (len > MAX_TAG_LEN) {
3728
        len = MAX_TAG_LEN;
3729
    }
3730
    /* s->tag is non-NULL terminated string */
3731
    s->tag = qemu_malloc(len);
3732
    memcpy(s->tag, conf->tag, len);
3733
    s->tag_len = len;
3734
    s->ctx.uid = -1;
3735

    
3736
    s->ops = fse->ops;
3737
    s->vdev.get_features = virtio_9p_get_features;
3738
    s->config_size = sizeof(struct virtio_9p_config) +
3739
                        s->tag_len;
3740
    s->vdev.get_config = virtio_9p_get_config;
3741

    
3742
    return &s->vdev;
3743
}