Statistics
| Branch: | Revision:

root / hw / virtio-9p.c @ 56d15a53

History | View | Annotate | Download (93.5 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
    default:
325
        printf("Number_to_string: Unknown number format\n");
326
        return -1;
327
    }
328

    
329
    return ret;
330
}
331

    
332
static int GCC_FMT_ATTR(2, 0)
333
v9fs_string_alloc_printf(char **strp, const char *fmt, va_list ap)
334
{
335
    va_list ap2;
336
    char *iter = (char *)fmt;
337
    int len = 0;
338
    int nr_args = 0;
339
    char *arg_char_ptr;
340
    unsigned int arg_uint;
341

    
342
    /* Find the number of %'s that denotes an argument */
343
    for (iter = strstr(iter, "%"); iter; iter = strstr(iter, "%")) {
344
        nr_args++;
345
        iter++;
346
    }
347

    
348
    len = strlen(fmt) - 2*nr_args;
349

    
350
    if (!nr_args) {
351
        goto alloc_print;
352
    }
353

    
354
    va_copy(ap2, ap);
355

    
356
    iter = (char *)fmt;
357

    
358
    /* Now parse the format string */
359
    for (iter = strstr(iter, "%"); iter; iter = strstr(iter, "%")) {
360
        iter++;
361
        switch (*iter) {
362
        case 'u':
363
            arg_uint = va_arg(ap2, unsigned int);
364
            len += number_to_string((void *)&arg_uint, 'u');
365
            break;
366
        case 's':
367
            arg_char_ptr = va_arg(ap2, char *);
368
            len += strlen(arg_char_ptr);
369
            break;
370
        case 'c':
371
            len += 1;
372
            break;
373
        default:
374
            fprintf(stderr,
375
                    "v9fs_string_alloc_printf:Incorrect format %c", *iter);
376
            return -1;
377
        }
378
        iter++;
379
    }
380

    
381
alloc_print:
382
    *strp = qemu_malloc((len + 1) * sizeof(**strp));
383

    
384
    return vsprintf(*strp, fmt, ap);
385
}
386

    
387
static void GCC_FMT_ATTR(2, 3)
388
v9fs_string_sprintf(V9fsString *str, const char *fmt, ...)
389
{
390
    va_list ap;
391
    int err;
392

    
393
    v9fs_string_free(str);
394

    
395
    va_start(ap, fmt);
396
    err = v9fs_string_alloc_printf(&str->data, fmt, ap);
397
    BUG_ON(err == -1);
398
    va_end(ap);
399

    
400
    str->size = err;
401
}
402

    
403
static void v9fs_string_copy(V9fsString *lhs, V9fsString *rhs)
404
{
405
    v9fs_string_free(lhs);
406
    v9fs_string_sprintf(lhs, "%s", rhs->data);
407
}
408

    
409
static size_t v9fs_string_size(V9fsString *str)
410
{
411
    return str->size;
412
}
413

    
414
static V9fsFidState *lookup_fid(V9fsState *s, int32_t fid)
415
{
416
    V9fsFidState *f;
417

    
418
    for (f = s->fid_list; f; f = f->next) {
419
        if (f->fid == fid) {
420
            return f;
421
        }
422
    }
423

    
424
    return NULL;
425
}
426

    
427
static V9fsFidState *alloc_fid(V9fsState *s, int32_t fid)
428
{
429
    V9fsFidState *f;
430

    
431
    f = lookup_fid(s, fid);
432
    if (f) {
433
        return NULL;
434
    }
435

    
436
    f = qemu_mallocz(sizeof(V9fsFidState));
437

    
438
    f->fid = fid;
439
    f->fid_type = P9_FID_NONE;
440

    
441
    f->next = s->fid_list;
442
    s->fid_list = f;
443

    
444
    return f;
445
}
446

    
447
static int v9fs_xattr_fid_clunk(V9fsState *s, V9fsFidState *fidp)
448
{
449
    int retval = 0;
450

    
451
    if (fidp->fs.xattr.copied_len == -1) {
452
        /* getxattr/listxattr fid */
453
        goto free_value;
454
    }
455
    /*
456
     * if this is fid for setxattr. clunk should
457
     * result in setxattr localcall
458
     */
459
    if (fidp->fs.xattr.len != fidp->fs.xattr.copied_len) {
460
        /* clunk after partial write */
461
        retval = -EINVAL;
462
        goto free_out;
463
    }
464
    if (fidp->fs.xattr.len) {
465
        retval = v9fs_do_lsetxattr(s, &fidp->path, &fidp->fs.xattr.name,
466
                                   fidp->fs.xattr.value,
467
                                   fidp->fs.xattr.len,
468
                                   fidp->fs.xattr.flags);
469
    } else {
470
        retval = v9fs_do_lremovexattr(s, &fidp->path, &fidp->fs.xattr.name);
471
    }
472
free_out:
473
    v9fs_string_free(&fidp->fs.xattr.name);
474
free_value:
475
    if (fidp->fs.xattr.value) {
476
        qemu_free(fidp->fs.xattr.value);
477
    }
478
    return retval;
479
}
480

    
481
static int free_fid(V9fsState *s, int32_t fid)
482
{
483
    int retval = 0;
484
    V9fsFidState **fidpp, *fidp;
485

    
486
    for (fidpp = &s->fid_list; *fidpp; fidpp = &(*fidpp)->next) {
487
        if ((*fidpp)->fid == fid) {
488
            break;
489
        }
490
    }
491

    
492
    if (*fidpp == NULL) {
493
        return -ENOENT;
494
    }
495

    
496
    fidp = *fidpp;
497
    *fidpp = fidp->next;
498

    
499
    if (fidp->fid_type == P9_FID_FILE) {
500
        v9fs_do_close(s, fidp->fs.fd);
501
    } else if (fidp->fid_type == P9_FID_DIR) {
502
        v9fs_do_closedir(s, fidp->fs.dir);
503
    } else if (fidp->fid_type == P9_FID_XATTR) {
504
        retval = v9fs_xattr_fid_clunk(s, fidp);
505
    }
506
    v9fs_string_free(&fidp->path);
507
    qemu_free(fidp);
508

    
509
    return retval;
510
}
511

    
512
#define P9_QID_TYPE_DIR         0x80
513
#define P9_QID_TYPE_SYMLINK     0x02
514

    
515
#define P9_STAT_MODE_DIR        0x80000000
516
#define P9_STAT_MODE_APPEND     0x40000000
517
#define P9_STAT_MODE_EXCL       0x20000000
518
#define P9_STAT_MODE_MOUNT      0x10000000
519
#define P9_STAT_MODE_AUTH       0x08000000
520
#define P9_STAT_MODE_TMP        0x04000000
521
#define P9_STAT_MODE_SYMLINK    0x02000000
522
#define P9_STAT_MODE_LINK       0x01000000
523
#define P9_STAT_MODE_DEVICE     0x00800000
524
#define P9_STAT_MODE_NAMED_PIPE 0x00200000
525
#define P9_STAT_MODE_SOCKET     0x00100000
526
#define P9_STAT_MODE_SETUID     0x00080000
527
#define P9_STAT_MODE_SETGID     0x00040000
528
#define P9_STAT_MODE_SETVTX     0x00010000
529

    
530
#define P9_STAT_MODE_TYPE_BITS (P9_STAT_MODE_DIR |          \
531
                                P9_STAT_MODE_SYMLINK |      \
532
                                P9_STAT_MODE_LINK |         \
533
                                P9_STAT_MODE_DEVICE |       \
534
                                P9_STAT_MODE_NAMED_PIPE |   \
535
                                P9_STAT_MODE_SOCKET)
536

    
537
/* This is the algorithm from ufs in spfs */
538
static void stat_to_qid(const struct stat *stbuf, V9fsQID *qidp)
539
{
540
    size_t size;
541

    
542
    size = MIN(sizeof(stbuf->st_ino), sizeof(qidp->path));
543
    memcpy(&qidp->path, &stbuf->st_ino, size);
544
    qidp->version = stbuf->st_mtime ^ (stbuf->st_size << 8);
545
    qidp->type = 0;
546
    if (S_ISDIR(stbuf->st_mode)) {
547
        qidp->type |= P9_QID_TYPE_DIR;
548
    }
549
    if (S_ISLNK(stbuf->st_mode)) {
550
        qidp->type |= P9_QID_TYPE_SYMLINK;
551
    }
552
}
553

    
554
static int fid_to_qid(V9fsState *s, V9fsFidState *fidp, V9fsQID *qidp)
555
{
556
    struct stat stbuf;
557
    int err;
558

    
559
    err = v9fs_do_lstat(s, &fidp->path, &stbuf);
560
    if (err) {
561
        return err;
562
    }
563

    
564
    stat_to_qid(&stbuf, qidp);
565
    return 0;
566
}
567

    
568
static V9fsPDU *alloc_pdu(V9fsState *s)
569
{
570
    V9fsPDU *pdu = NULL;
571

    
572
    if (!QLIST_EMPTY(&s->free_list)) {
573
        pdu = QLIST_FIRST(&s->free_list);
574
        QLIST_REMOVE(pdu, next);
575
    }
576
    return pdu;
577
}
578

    
579
static void free_pdu(V9fsState *s, V9fsPDU *pdu)
580
{
581
    if (pdu) {
582
        QLIST_INSERT_HEAD(&s->free_list, pdu, next);
583
    }
584
}
585

    
586
size_t pdu_packunpack(void *addr, struct iovec *sg, int sg_count,
587
                        size_t offset, size_t size, int pack)
588
{
589
    int i = 0;
590
    size_t copied = 0;
591

    
592
    for (i = 0; size && i < sg_count; i++) {
593
        size_t len;
594
        if (offset >= sg[i].iov_len) {
595
            /* skip this sg */
596
            offset -= sg[i].iov_len;
597
            continue;
598
        } else {
599
            len = MIN(sg[i].iov_len - offset, size);
600
            if (pack) {
601
                memcpy(sg[i].iov_base + offset, addr, len);
602
            } else {
603
                memcpy(addr, sg[i].iov_base + offset, len);
604
            }
605
            size -= len;
606
            copied += len;
607
            addr += len;
608
            if (size) {
609
                offset = 0;
610
                continue;
611
            }
612
        }
613
    }
614

    
615
    return copied;
616
}
617

    
618
static size_t pdu_unpack(void *dst, V9fsPDU *pdu, size_t offset, size_t size)
619
{
620
    return pdu_packunpack(dst, pdu->elem.out_sg, pdu->elem.out_num,
621
                         offset, size, 0);
622
}
623

    
624
static size_t pdu_pack(V9fsPDU *pdu, size_t offset, const void *src,
625
                        size_t size)
626
{
627
    return pdu_packunpack((void *)src, pdu->elem.in_sg, pdu->elem.in_num,
628
                             offset, size, 1);
629
}
630

    
631
static int pdu_copy_sg(V9fsPDU *pdu, size_t offset, int rx, struct iovec *sg)
632
{
633
    size_t pos = 0;
634
    int i, j;
635
    struct iovec *src_sg;
636
    unsigned int num;
637

    
638
    if (rx) {
639
        src_sg = pdu->elem.in_sg;
640
        num = pdu->elem.in_num;
641
    } else {
642
        src_sg = pdu->elem.out_sg;
643
        num = pdu->elem.out_num;
644
    }
645

    
646
    j = 0;
647
    for (i = 0; i < num; i++) {
648
        if (offset <= pos) {
649
            sg[j].iov_base = src_sg[i].iov_base;
650
            sg[j].iov_len = src_sg[i].iov_len;
651
            j++;
652
        } else if (offset < (src_sg[i].iov_len + pos)) {
653
            sg[j].iov_base = src_sg[i].iov_base;
654
            sg[j].iov_len = src_sg[i].iov_len;
655
            sg[j].iov_base += (offset - pos);
656
            sg[j].iov_len -= (offset - pos);
657
            j++;
658
        }
659
        pos += src_sg[i].iov_len;
660
    }
661

    
662
    return j;
663
}
664

    
665
static size_t pdu_unmarshal(V9fsPDU *pdu, size_t offset, const char *fmt, ...)
666
{
667
    size_t old_offset = offset;
668
    va_list ap;
669
    int i;
670

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

    
750
    va_end(ap);
751

    
752
    return offset - old_offset;
753
}
754

    
755
static size_t pdu_marshal(V9fsPDU *pdu, size_t offset, const char *fmt, ...)
756
{
757
    size_t old_offset = offset;
758
    va_list ap;
759
    int i;
760

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

    
837
    return offset - old_offset;
838
}
839

    
840
static void complete_pdu(V9fsState *s, V9fsPDU *pdu, ssize_t len)
841
{
842
    int8_t id = pdu->id + 1; /* Response */
843

    
844
    if (len < 0) {
845
        int err = -len;
846
        len = 7;
847

    
848
        if (s->proto_version != V9FS_PROTO_2000L) {
849
            V9fsString str;
850

    
851
            str.data = strerror(err);
852
            str.size = strlen(str.data);
853

    
854
            len += pdu_marshal(pdu, len, "s", &str);
855
            id = P9_RERROR;
856
        }
857

    
858
        len += pdu_marshal(pdu, len, "d", err);
859

    
860
        if (s->proto_version == V9FS_PROTO_2000L) {
861
            id = P9_RLERROR;
862
        }
863
    }
864

    
865
    /* fill out the header */
866
    pdu_marshal(pdu, 0, "dbw", (int32_t)len, id, pdu->tag);
867

    
868
    /* keep these in sync */
869
    pdu->size = len;
870
    pdu->id = id;
871

    
872
    /* push onto queue and notify */
873
    virtqueue_push(s->vq, &pdu->elem, len);
874

    
875
    /* FIXME: we should batch these completions */
876
    virtio_notify(&s->vdev, s->vq);
877

    
878
    free_pdu(s, pdu);
879
}
880

    
881
static mode_t v9mode_to_mode(uint32_t mode, V9fsString *extension)
882
{
883
    mode_t ret;
884

    
885
    ret = mode & 0777;
886
    if (mode & P9_STAT_MODE_DIR) {
887
        ret |= S_IFDIR;
888
    }
889

    
890
    if (mode & P9_STAT_MODE_SYMLINK) {
891
        ret |= S_IFLNK;
892
    }
893
    if (mode & P9_STAT_MODE_SOCKET) {
894
        ret |= S_IFSOCK;
895
    }
896
    if (mode & P9_STAT_MODE_NAMED_PIPE) {
897
        ret |= S_IFIFO;
898
    }
899
    if (mode & P9_STAT_MODE_DEVICE) {
900
        if (extension && extension->data[0] == 'c') {
901
            ret |= S_IFCHR;
902
        } else {
903
            ret |= S_IFBLK;
904
        }
905
    }
906

    
907
    if (!(ret&~0777)) {
908
        ret |= S_IFREG;
909
    }
910

    
911
    if (mode & P9_STAT_MODE_SETUID) {
912
        ret |= S_ISUID;
913
    }
914
    if (mode & P9_STAT_MODE_SETGID) {
915
        ret |= S_ISGID;
916
    }
917
    if (mode & P9_STAT_MODE_SETVTX) {
918
        ret |= S_ISVTX;
919
    }
920

    
921
    return ret;
922
}
923

    
924
static int donttouch_stat(V9fsStat *stat)
925
{
926
    if (stat->type == -1 &&
927
        stat->dev == -1 &&
928
        stat->qid.type == -1 &&
929
        stat->qid.version == -1 &&
930
        stat->qid.path == -1 &&
931
        stat->mode == -1 &&
932
        stat->atime == -1 &&
933
        stat->mtime == -1 &&
934
        stat->length == -1 &&
935
        !stat->name.size &&
936
        !stat->uid.size &&
937
        !stat->gid.size &&
938
        !stat->muid.size &&
939
        stat->n_uid == -1 &&
940
        stat->n_gid == -1 &&
941
        stat->n_muid == -1) {
942
        return 1;
943
    }
944

    
945
    return 0;
946
}
947

    
948
static void v9fs_stat_free(V9fsStat *stat)
949
{
950
    v9fs_string_free(&stat->name);
951
    v9fs_string_free(&stat->uid);
952
    v9fs_string_free(&stat->gid);
953
    v9fs_string_free(&stat->muid);
954
    v9fs_string_free(&stat->extension);
955
}
956

    
957
static uint32_t stat_to_v9mode(const struct stat *stbuf)
958
{
959
    uint32_t mode;
960

    
961
    mode = stbuf->st_mode & 0777;
962
    if (S_ISDIR(stbuf->st_mode)) {
963
        mode |= P9_STAT_MODE_DIR;
964
    }
965

    
966
    if (S_ISLNK(stbuf->st_mode)) {
967
        mode |= P9_STAT_MODE_SYMLINK;
968
    }
969

    
970
    if (S_ISSOCK(stbuf->st_mode)) {
971
        mode |= P9_STAT_MODE_SOCKET;
972
    }
973

    
974
    if (S_ISFIFO(stbuf->st_mode)) {
975
        mode |= P9_STAT_MODE_NAMED_PIPE;
976
    }
977

    
978
    if (S_ISBLK(stbuf->st_mode) || S_ISCHR(stbuf->st_mode)) {
979
        mode |= P9_STAT_MODE_DEVICE;
980
    }
981

    
982
    if (stbuf->st_mode & S_ISUID) {
983
        mode |= P9_STAT_MODE_SETUID;
984
    }
985

    
986
    if (stbuf->st_mode & S_ISGID) {
987
        mode |= P9_STAT_MODE_SETGID;
988
    }
989

    
990
    if (stbuf->st_mode & S_ISVTX) {
991
        mode |= P9_STAT_MODE_SETVTX;
992
    }
993

    
994
    return mode;
995
}
996

    
997
static int stat_to_v9stat(V9fsState *s, V9fsString *name,
998
                            const struct stat *stbuf,
999
                            V9fsStat *v9stat)
1000
{
1001
    int err;
1002
    const char *str;
1003

    
1004
    memset(v9stat, 0, sizeof(*v9stat));
1005

    
1006
    stat_to_qid(stbuf, &v9stat->qid);
1007
    v9stat->mode = stat_to_v9mode(stbuf);
1008
    v9stat->atime = stbuf->st_atime;
1009
    v9stat->mtime = stbuf->st_mtime;
1010
    v9stat->length = stbuf->st_size;
1011

    
1012
    v9fs_string_null(&v9stat->uid);
1013
    v9fs_string_null(&v9stat->gid);
1014
    v9fs_string_null(&v9stat->muid);
1015

    
1016
    v9stat->n_uid = stbuf->st_uid;
1017
    v9stat->n_gid = stbuf->st_gid;
1018
    v9stat->n_muid = 0;
1019

    
1020
    v9fs_string_null(&v9stat->extension);
1021

    
1022
    if (v9stat->mode & P9_STAT_MODE_SYMLINK) {
1023
        err = v9fs_do_readlink(s, name, &v9stat->extension);
1024
        if (err == -1) {
1025
            err = -errno;
1026
            return err;
1027
        }
1028
        v9stat->extension.data[err] = 0;
1029
        v9stat->extension.size = err;
1030
    } else if (v9stat->mode & P9_STAT_MODE_DEVICE) {
1031
        v9fs_string_sprintf(&v9stat->extension, "%c %u %u",
1032
                S_ISCHR(stbuf->st_mode) ? 'c' : 'b',
1033
                major(stbuf->st_rdev), minor(stbuf->st_rdev));
1034
    } else if (S_ISDIR(stbuf->st_mode) || S_ISREG(stbuf->st_mode)) {
1035
        v9fs_string_sprintf(&v9stat->extension, "%s %lu",
1036
                "HARDLINKCOUNT", (unsigned long)stbuf->st_nlink);
1037
    }
1038

    
1039
    str = strrchr(name->data, '/');
1040
    if (str) {
1041
        str += 1;
1042
    } else {
1043
        str = name->data;
1044
    }
1045

    
1046
    v9fs_string_sprintf(&v9stat->name, "%s", str);
1047

    
1048
    v9stat->size = 61 +
1049
        v9fs_string_size(&v9stat->name) +
1050
        v9fs_string_size(&v9stat->uid) +
1051
        v9fs_string_size(&v9stat->gid) +
1052
        v9fs_string_size(&v9stat->muid) +
1053
        v9fs_string_size(&v9stat->extension);
1054
    return 0;
1055
}
1056

    
1057
#define P9_STATS_MODE          0x00000001ULL
1058
#define P9_STATS_NLINK         0x00000002ULL
1059
#define P9_STATS_UID           0x00000004ULL
1060
#define P9_STATS_GID           0x00000008ULL
1061
#define P9_STATS_RDEV          0x00000010ULL
1062
#define P9_STATS_ATIME         0x00000020ULL
1063
#define P9_STATS_MTIME         0x00000040ULL
1064
#define P9_STATS_CTIME         0x00000080ULL
1065
#define P9_STATS_INO           0x00000100ULL
1066
#define P9_STATS_SIZE          0x00000200ULL
1067
#define P9_STATS_BLOCKS        0x00000400ULL
1068

    
1069
#define P9_STATS_BTIME         0x00000800ULL
1070
#define P9_STATS_GEN           0x00001000ULL
1071
#define P9_STATS_DATA_VERSION  0x00002000ULL
1072

    
1073
#define P9_STATS_BASIC         0x000007ffULL /* Mask for fields up to BLOCKS */
1074
#define P9_STATS_ALL           0x00003fffULL /* Mask for All fields above */
1075

    
1076

    
1077
static void stat_to_v9stat_dotl(V9fsState *s, const struct stat *stbuf,
1078
                            V9fsStatDotl *v9lstat)
1079
{
1080
    memset(v9lstat, 0, sizeof(*v9lstat));
1081

    
1082
    v9lstat->st_mode = stbuf->st_mode;
1083
    v9lstat->st_nlink = stbuf->st_nlink;
1084
    v9lstat->st_uid = stbuf->st_uid;
1085
    v9lstat->st_gid = stbuf->st_gid;
1086
    v9lstat->st_rdev = stbuf->st_rdev;
1087
    v9lstat->st_size = stbuf->st_size;
1088
    v9lstat->st_blksize = stbuf->st_blksize;
1089
    v9lstat->st_blocks = stbuf->st_blocks;
1090
    v9lstat->st_atime_sec = stbuf->st_atime;
1091
    v9lstat->st_atime_nsec = stbuf->st_atim.tv_nsec;
1092
    v9lstat->st_mtime_sec = stbuf->st_mtime;
1093
    v9lstat->st_mtime_nsec = stbuf->st_mtim.tv_nsec;
1094
    v9lstat->st_ctime_sec = stbuf->st_ctime;
1095
    v9lstat->st_ctime_nsec = stbuf->st_ctim.tv_nsec;
1096
    /* Currently we only support BASIC fields in stat */
1097
    v9lstat->st_result_mask = P9_STATS_BASIC;
1098

    
1099
    stat_to_qid(stbuf, &v9lstat->qid);
1100
}
1101

    
1102
static struct iovec *adjust_sg(struct iovec *sg, int len, int *iovcnt)
1103
{
1104
    while (len && *iovcnt) {
1105
        if (len < sg->iov_len) {
1106
            sg->iov_len -= len;
1107
            sg->iov_base += len;
1108
            len = 0;
1109
        } else {
1110
            len -= sg->iov_len;
1111
            sg++;
1112
            *iovcnt -= 1;
1113
        }
1114
    }
1115

    
1116
    return sg;
1117
}
1118

    
1119
static struct iovec *cap_sg(struct iovec *sg, int cap, int *cnt)
1120
{
1121
    int i;
1122
    int total = 0;
1123

    
1124
    for (i = 0; i < *cnt; i++) {
1125
        if ((total + sg[i].iov_len) > cap) {
1126
            sg[i].iov_len -= ((total + sg[i].iov_len) - cap);
1127
            i++;
1128
            break;
1129
        }
1130
        total += sg[i].iov_len;
1131
    }
1132

    
1133
    *cnt = i;
1134

    
1135
    return sg;
1136
}
1137

    
1138
static void print_sg(struct iovec *sg, int cnt)
1139
{
1140
    int i;
1141

    
1142
    printf("sg[%d]: {", cnt);
1143
    for (i = 0; i < cnt; i++) {
1144
        if (i) {
1145
            printf(", ");
1146
        }
1147
        printf("(%p, %zd)", sg[i].iov_base, sg[i].iov_len);
1148
    }
1149
    printf("}\n");
1150
}
1151

    
1152
static void v9fs_fix_path(V9fsString *dst, V9fsString *src, int len)
1153
{
1154
    V9fsString str;
1155
    v9fs_string_init(&str);
1156
    v9fs_string_copy(&str, dst);
1157
    v9fs_string_sprintf(dst, "%s%s", src->data, str.data+len);
1158
    v9fs_string_free(&str);
1159
}
1160

    
1161
static void v9fs_version(V9fsState *s, V9fsPDU *pdu)
1162
{
1163
    V9fsString version;
1164
    size_t offset = 7;
1165

    
1166
    pdu_unmarshal(pdu, offset, "ds", &s->msize, &version);
1167

    
1168
    if (!strcmp(version.data, "9P2000.u")) {
1169
        s->proto_version = V9FS_PROTO_2000U;
1170
    } else if (!strcmp(version.data, "9P2000.L")) {
1171
        s->proto_version = V9FS_PROTO_2000L;
1172
    } else {
1173
        v9fs_string_sprintf(&version, "unknown");
1174
    }
1175

    
1176
    offset += pdu_marshal(pdu, offset, "ds", s->msize, &version);
1177
    complete_pdu(s, pdu, offset);
1178

    
1179
    v9fs_string_free(&version);
1180
}
1181

    
1182
static void v9fs_attach(V9fsState *s, V9fsPDU *pdu)
1183
{
1184
    int32_t fid, afid, n_uname;
1185
    V9fsString uname, aname;
1186
    V9fsFidState *fidp;
1187
    V9fsQID qid;
1188
    size_t offset = 7;
1189
    ssize_t err;
1190

    
1191
    pdu_unmarshal(pdu, offset, "ddssd", &fid, &afid, &uname, &aname, &n_uname);
1192

    
1193
    fidp = alloc_fid(s, fid);
1194
    if (fidp == NULL) {
1195
        err = -EINVAL;
1196
        goto out;
1197
    }
1198

    
1199
    fidp->uid = n_uname;
1200

    
1201
    v9fs_string_sprintf(&fidp->path, "%s", "/");
1202
    err = fid_to_qid(s, fidp, &qid);
1203
    if (err) {
1204
        err = -EINVAL;
1205
        free_fid(s, fid);
1206
        goto out;
1207
    }
1208

    
1209
    offset += pdu_marshal(pdu, offset, "Q", &qid);
1210

    
1211
    err = offset;
1212
out:
1213
    complete_pdu(s, pdu, err);
1214
    v9fs_string_free(&uname);
1215
    v9fs_string_free(&aname);
1216
}
1217

    
1218
static void v9fs_stat_post_lstat(V9fsState *s, V9fsStatState *vs, int err)
1219
{
1220
    if (err == -1) {
1221
        err = -errno;
1222
        goto out;
1223
    }
1224

    
1225
    err = stat_to_v9stat(s, &vs->fidp->path, &vs->stbuf, &vs->v9stat);
1226
    if (err) {
1227
        goto out;
1228
    }
1229
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "wS", 0, &vs->v9stat);
1230
    err = vs->offset;
1231

    
1232
out:
1233
    complete_pdu(s, vs->pdu, err);
1234
    v9fs_stat_free(&vs->v9stat);
1235
    qemu_free(vs);
1236
}
1237

    
1238
static void v9fs_stat(V9fsState *s, V9fsPDU *pdu)
1239
{
1240
    int32_t fid;
1241
    V9fsStatState *vs;
1242
    ssize_t err = 0;
1243

    
1244
    vs = qemu_malloc(sizeof(*vs));
1245
    vs->pdu = pdu;
1246
    vs->offset = 7;
1247

    
1248
    memset(&vs->v9stat, 0, sizeof(vs->v9stat));
1249

    
1250
    pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
1251

    
1252
    vs->fidp = lookup_fid(s, fid);
1253
    if (vs->fidp == NULL) {
1254
        err = -ENOENT;
1255
        goto out;
1256
    }
1257

    
1258
    err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1259
    v9fs_stat_post_lstat(s, vs, err);
1260
    return;
1261

    
1262
out:
1263
    complete_pdu(s, vs->pdu, err);
1264
    v9fs_stat_free(&vs->v9stat);
1265
    qemu_free(vs);
1266
}
1267

    
1268
static void v9fs_getattr_post_lstat(V9fsState *s, V9fsStatStateDotl *vs,
1269
                                                                int err)
1270
{
1271
    if (err == -1) {
1272
        err = -errno;
1273
        goto out;
1274
    }
1275

    
1276
    stat_to_v9stat_dotl(s, &vs->stbuf, &vs->v9stat_dotl);
1277
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "A", &vs->v9stat_dotl);
1278
    err = vs->offset;
1279

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

    
1285
static void v9fs_getattr(V9fsState *s, V9fsPDU *pdu)
1286
{
1287
    int32_t fid;
1288
    V9fsStatStateDotl *vs;
1289
    ssize_t err = 0;
1290
    V9fsFidState *fidp;
1291
    uint64_t request_mask;
1292

    
1293
    vs = qemu_malloc(sizeof(*vs));
1294
    vs->pdu = pdu;
1295
    vs->offset = 7;
1296

    
1297
    memset(&vs->v9stat_dotl, 0, sizeof(vs->v9stat_dotl));
1298

    
1299
    pdu_unmarshal(vs->pdu, vs->offset, "dq", &fid, &request_mask);
1300

    
1301
    fidp = lookup_fid(s, fid);
1302
    if (fidp == NULL) {
1303
        err = -ENOENT;
1304
        goto out;
1305
    }
1306

    
1307
    /* Currently we only support BASIC fields in stat, so there is no
1308
     * need to look at request_mask.
1309
     */
1310
    err = v9fs_do_lstat(s, &fidp->path, &vs->stbuf);
1311
    v9fs_getattr_post_lstat(s, vs, err);
1312
    return;
1313

    
1314
out:
1315
    complete_pdu(s, vs->pdu, err);
1316
    qemu_free(vs);
1317
}
1318

    
1319
/* From Linux kernel code */
1320
#define ATTR_MODE    (1 << 0)
1321
#define ATTR_UID     (1 << 1)
1322
#define ATTR_GID     (1 << 2)
1323
#define ATTR_SIZE    (1 << 3)
1324
#define ATTR_ATIME   (1 << 4)
1325
#define ATTR_MTIME   (1 << 5)
1326
#define ATTR_CTIME   (1 << 6)
1327
#define ATTR_MASK    127
1328
#define ATTR_ATIME_SET  (1 << 7)
1329
#define ATTR_MTIME_SET  (1 << 8)
1330

    
1331
static void v9fs_setattr_post_truncate(V9fsState *s, V9fsSetattrState *vs,
1332
                                                                  int err)
1333
{
1334
    if (err == -1) {
1335
        err = -errno;
1336
        goto out;
1337
    }
1338
    err = vs->offset;
1339

    
1340
out:
1341
    complete_pdu(s, vs->pdu, err);
1342
    qemu_free(vs);
1343
}
1344

    
1345
static void v9fs_setattr_post_chown(V9fsState *s, V9fsSetattrState *vs, int err)
1346
{
1347
    if (err == -1) {
1348
        err = -errno;
1349
        goto out;
1350
    }
1351

    
1352
    if (vs->v9iattr.valid & (ATTR_SIZE)) {
1353
        err = v9fs_do_truncate(s, &vs->fidp->path, vs->v9iattr.size);
1354
    }
1355
    v9fs_setattr_post_truncate(s, vs, err);
1356
    return;
1357

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

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

    
1371
    /* If the only valid entry in iattr is ctime we can call
1372
     * chown(-1,-1) to update the ctime of the file
1373
     */
1374
    if ((vs->v9iattr.valid & (ATTR_UID | ATTR_GID)) ||
1375
            ((vs->v9iattr.valid & ATTR_CTIME)
1376
            && !((vs->v9iattr.valid & ATTR_MASK) & ~ATTR_CTIME))) {
1377
        if (!(vs->v9iattr.valid & ATTR_UID)) {
1378
            vs->v9iattr.uid = -1;
1379
        }
1380
        if (!(vs->v9iattr.valid & ATTR_GID)) {
1381
            vs->v9iattr.gid = -1;
1382
        }
1383
        err = v9fs_do_chown(s, &vs->fidp->path, vs->v9iattr.uid,
1384
                                                vs->v9iattr.gid);
1385
    }
1386
    v9fs_setattr_post_chown(s, vs, err);
1387
    return;
1388

    
1389
out:
1390
    complete_pdu(s, vs->pdu, err);
1391
    qemu_free(vs);
1392
}
1393

    
1394
static void v9fs_setattr_post_chmod(V9fsState *s, V9fsSetattrState *vs, int err)
1395
{
1396
    if (err == -1) {
1397
        err = -errno;
1398
        goto out;
1399
    }
1400

    
1401
    if (vs->v9iattr.valid & (ATTR_ATIME | ATTR_MTIME)) {
1402
        struct timespec times[2];
1403
        if (vs->v9iattr.valid & ATTR_ATIME) {
1404
            if (vs->v9iattr.valid & ATTR_ATIME_SET) {
1405
                times[0].tv_sec = vs->v9iattr.atime_sec;
1406
                times[0].tv_nsec = vs->v9iattr.atime_nsec;
1407
            } else {
1408
                times[0].tv_nsec = UTIME_NOW;
1409
            }
1410
        } else {
1411
            times[0].tv_nsec = UTIME_OMIT;
1412
        }
1413

    
1414
        if (vs->v9iattr.valid & ATTR_MTIME) {
1415
            if (vs->v9iattr.valid & ATTR_MTIME_SET) {
1416
                times[1].tv_sec = vs->v9iattr.mtime_sec;
1417
                times[1].tv_nsec = vs->v9iattr.mtime_nsec;
1418
            } else {
1419
                times[1].tv_nsec = UTIME_NOW;
1420
            }
1421
        } else {
1422
            times[1].tv_nsec = UTIME_OMIT;
1423
        }
1424
        err = v9fs_do_utimensat(s, &vs->fidp->path, times);
1425
    }
1426
    v9fs_setattr_post_utimensat(s, vs, err);
1427
    return;
1428

    
1429
out:
1430
    complete_pdu(s, vs->pdu, err);
1431
    qemu_free(vs);
1432
}
1433

    
1434
static void v9fs_setattr(V9fsState *s, V9fsPDU *pdu)
1435
{
1436
    int32_t fid;
1437
    V9fsSetattrState *vs;
1438
    int err = 0;
1439

    
1440
    vs = qemu_malloc(sizeof(*vs));
1441
    vs->pdu = pdu;
1442
    vs->offset = 7;
1443

    
1444
    pdu_unmarshal(pdu, vs->offset, "dI", &fid, &vs->v9iattr);
1445

    
1446
    vs->fidp = lookup_fid(s, fid);
1447
    if (vs->fidp == NULL) {
1448
        err = -EINVAL;
1449
        goto out;
1450
    }
1451

    
1452
    if (vs->v9iattr.valid & ATTR_MODE) {
1453
        err = v9fs_do_chmod(s, &vs->fidp->path, vs->v9iattr.mode);
1454
    }
1455

    
1456
    v9fs_setattr_post_chmod(s, vs, err);
1457
    return;
1458

    
1459
out:
1460
    complete_pdu(s, vs->pdu, err);
1461
    qemu_free(vs);
1462
}
1463

    
1464
static void v9fs_walk_complete(V9fsState *s, V9fsWalkState *vs, int err)
1465
{
1466
    complete_pdu(s, vs->pdu, err);
1467

    
1468
    if (vs->nwnames) {
1469
        for (vs->name_idx = 0; vs->name_idx < vs->nwnames; vs->name_idx++) {
1470
            v9fs_string_free(&vs->wnames[vs->name_idx]);
1471
        }
1472

    
1473
        qemu_free(vs->wnames);
1474
        qemu_free(vs->qids);
1475
    }
1476
}
1477

    
1478
static void v9fs_walk_marshal(V9fsWalkState *vs)
1479
{
1480
    int i;
1481
    vs->offset = 7;
1482
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "w", vs->nwnames);
1483

    
1484
    for (i = 0; i < vs->nwnames; i++) {
1485
        vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qids[i]);
1486
    }
1487
}
1488

    
1489
static void v9fs_walk_post_newfid_lstat(V9fsState *s, V9fsWalkState *vs,
1490
                                                                int err)
1491
{
1492
    if (err == -1) {
1493
        free_fid(s, vs->newfidp->fid);
1494
        v9fs_string_free(&vs->path);
1495
        err = -ENOENT;
1496
        goto out;
1497
    }
1498

    
1499
    stat_to_qid(&vs->stbuf, &vs->qids[vs->name_idx]);
1500

    
1501
    vs->name_idx++;
1502
    if (vs->name_idx < vs->nwnames) {
1503
        v9fs_string_sprintf(&vs->path, "%s/%s", vs->newfidp->path.data,
1504
                                            vs->wnames[vs->name_idx].data);
1505
        v9fs_string_copy(&vs->newfidp->path, &vs->path);
1506

    
1507
        err = v9fs_do_lstat(s, &vs->newfidp->path, &vs->stbuf);
1508
        v9fs_walk_post_newfid_lstat(s, vs, err);
1509
        return;
1510
    }
1511

    
1512
    v9fs_string_free(&vs->path);
1513
    v9fs_walk_marshal(vs);
1514
    err = vs->offset;
1515
out:
1516
    v9fs_walk_complete(s, vs, err);
1517
}
1518

    
1519
static void v9fs_walk_post_oldfid_lstat(V9fsState *s, V9fsWalkState *vs,
1520
        int err)
1521
{
1522
    if (err == -1) {
1523
        v9fs_string_free(&vs->path);
1524
        err = -ENOENT;
1525
        goto out;
1526
    }
1527

    
1528
    stat_to_qid(&vs->stbuf, &vs->qids[vs->name_idx]);
1529
    vs->name_idx++;
1530
    if (vs->name_idx < vs->nwnames) {
1531

    
1532
        v9fs_string_sprintf(&vs->path, "%s/%s",
1533
                vs->fidp->path.data, vs->wnames[vs->name_idx].data);
1534
        v9fs_string_copy(&vs->fidp->path, &vs->path);
1535

    
1536
        err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1537
        v9fs_walk_post_oldfid_lstat(s, vs, err);
1538
        return;
1539
    }
1540

    
1541
    v9fs_string_free(&vs->path);
1542
    v9fs_walk_marshal(vs);
1543
    err = vs->offset;
1544
out:
1545
    v9fs_walk_complete(s, vs, err);
1546
}
1547

    
1548
static void v9fs_walk(V9fsState *s, V9fsPDU *pdu)
1549
{
1550
    int32_t fid, newfid;
1551
    V9fsWalkState *vs;
1552
    int err = 0;
1553
    int i;
1554

    
1555
    vs = qemu_malloc(sizeof(*vs));
1556
    vs->pdu = pdu;
1557
    vs->wnames = NULL;
1558
    vs->qids = NULL;
1559
    vs->offset = 7;
1560

    
1561
    vs->offset += pdu_unmarshal(vs->pdu, vs->offset, "ddw", &fid,
1562
                                            &newfid, &vs->nwnames);
1563

    
1564
    if (vs->nwnames) {
1565
        vs->wnames = qemu_mallocz(sizeof(vs->wnames[0]) * vs->nwnames);
1566

    
1567
        vs->qids = qemu_mallocz(sizeof(vs->qids[0]) * vs->nwnames);
1568

    
1569
        for (i = 0; i < vs->nwnames; i++) {
1570
            vs->offset += pdu_unmarshal(vs->pdu, vs->offset, "s",
1571
                                            &vs->wnames[i]);
1572
        }
1573
    }
1574

    
1575
    vs->fidp = lookup_fid(s, fid);
1576
    if (vs->fidp == NULL) {
1577
        err = -ENOENT;
1578
        goto out;
1579
    }
1580

    
1581
    /* FIXME: is this really valid? */
1582
    if (fid == newfid) {
1583

    
1584
        BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
1585
        v9fs_string_init(&vs->path);
1586
        vs->name_idx = 0;
1587

    
1588
        if (vs->name_idx < vs->nwnames) {
1589
            v9fs_string_sprintf(&vs->path, "%s/%s",
1590
                vs->fidp->path.data, vs->wnames[vs->name_idx].data);
1591
            v9fs_string_copy(&vs->fidp->path, &vs->path);
1592

    
1593
            err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1594
            v9fs_walk_post_oldfid_lstat(s, vs, err);
1595
            return;
1596
        }
1597
    } else {
1598
        vs->newfidp = alloc_fid(s, newfid);
1599
        if (vs->newfidp == NULL) {
1600
            err = -EINVAL;
1601
            goto out;
1602
        }
1603

    
1604
        vs->newfidp->uid = vs->fidp->uid;
1605
        v9fs_string_init(&vs->path);
1606
        vs->name_idx = 0;
1607
        v9fs_string_copy(&vs->newfidp->path, &vs->fidp->path);
1608

    
1609
        if (vs->name_idx < vs->nwnames) {
1610
            v9fs_string_sprintf(&vs->path, "%s/%s", vs->newfidp->path.data,
1611
                                vs->wnames[vs->name_idx].data);
1612
            v9fs_string_copy(&vs->newfidp->path, &vs->path);
1613

    
1614
            err = v9fs_do_lstat(s, &vs->newfidp->path, &vs->stbuf);
1615
            v9fs_walk_post_newfid_lstat(s, vs, err);
1616
            return;
1617
        }
1618
    }
1619

    
1620
    v9fs_walk_marshal(vs);
1621
    err = vs->offset;
1622
out:
1623
    v9fs_walk_complete(s, vs, err);
1624
}
1625

    
1626
static int32_t get_iounit(V9fsState *s, V9fsString *name)
1627
{
1628
    struct statfs stbuf;
1629
    int32_t iounit = 0;
1630

    
1631
    /*
1632
     * iounit should be multiples of f_bsize (host filesystem block size
1633
     * and as well as less than (client msize - P9_IOHDRSZ))
1634
     */
1635
    if (!v9fs_do_statfs(s, name, &stbuf)) {
1636
        iounit = stbuf.f_bsize;
1637
        iounit *= (s->msize - P9_IOHDRSZ)/stbuf.f_bsize;
1638
    }
1639

    
1640
    if (!iounit) {
1641
        iounit = s->msize - P9_IOHDRSZ;
1642
    }
1643
    return iounit;
1644
}
1645

    
1646
static void v9fs_open_post_opendir(V9fsState *s, V9fsOpenState *vs, int err)
1647
{
1648
    if (vs->fidp->fs.dir == NULL) {
1649
        err = -errno;
1650
        goto out;
1651
    }
1652
    vs->fidp->fid_type = P9_FID_DIR;
1653
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, 0);
1654
    err = vs->offset;
1655
out:
1656
    complete_pdu(s, vs->pdu, err);
1657
    qemu_free(vs);
1658

    
1659
}
1660

    
1661
static void v9fs_open_post_getiounit(V9fsState *s, V9fsOpenState *vs)
1662
{
1663
    int err;
1664
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, vs->iounit);
1665
    err = vs->offset;
1666
    complete_pdu(s, vs->pdu, err);
1667
    qemu_free(vs);
1668
}
1669

    
1670
static void v9fs_open_post_open(V9fsState *s, V9fsOpenState *vs, int err)
1671
{
1672
    if (vs->fidp->fs.fd == -1) {
1673
        err = -errno;
1674
        goto out;
1675
    }
1676
    vs->fidp->fid_type = P9_FID_FILE;
1677
    vs->iounit = get_iounit(s, &vs->fidp->path);
1678
    v9fs_open_post_getiounit(s, vs);
1679
    return;
1680
out:
1681
    complete_pdu(s, vs->pdu, err);
1682
    qemu_free(vs);
1683
}
1684

    
1685
static void v9fs_open_post_lstat(V9fsState *s, V9fsOpenState *vs, int err)
1686
{
1687
    int flags;
1688

    
1689
    if (err) {
1690
        err = -errno;
1691
        goto out;
1692
    }
1693

    
1694
    stat_to_qid(&vs->stbuf, &vs->qid);
1695

    
1696
    if (S_ISDIR(vs->stbuf.st_mode)) {
1697
        vs->fidp->fs.dir = v9fs_do_opendir(s, &vs->fidp->path);
1698
        v9fs_open_post_opendir(s, vs, err);
1699
    } else {
1700
        if (s->proto_version == V9FS_PROTO_2000L) {
1701
            flags = vs->mode;
1702
            flags &= ~(O_NOCTTY | O_ASYNC | O_CREAT);
1703
            /* Ignore direct disk access hint until the server supports it. */
1704
            flags &= ~O_DIRECT;
1705
        } else {
1706
            flags = omode_to_uflags(vs->mode);
1707
        }
1708
        vs->fidp->fs.fd = v9fs_do_open(s, &vs->fidp->path, flags);
1709
        v9fs_open_post_open(s, vs, err);
1710
    }
1711
    return;
1712
out:
1713
    complete_pdu(s, vs->pdu, err);
1714
    qemu_free(vs);
1715
}
1716

    
1717
static void v9fs_open(V9fsState *s, V9fsPDU *pdu)
1718
{
1719
    int32_t fid;
1720
    V9fsOpenState *vs;
1721
    ssize_t err = 0;
1722

    
1723
    vs = qemu_malloc(sizeof(*vs));
1724
    vs->pdu = pdu;
1725
    vs->offset = 7;
1726
    vs->mode = 0;
1727

    
1728
    if (s->proto_version == V9FS_PROTO_2000L) {
1729
        pdu_unmarshal(vs->pdu, vs->offset, "dd", &fid, &vs->mode);
1730
    } else {
1731
        pdu_unmarshal(vs->pdu, vs->offset, "db", &fid, &vs->mode);
1732
    }
1733

    
1734
    vs->fidp = lookup_fid(s, fid);
1735
    if (vs->fidp == NULL) {
1736
        err = -ENOENT;
1737
        goto out;
1738
    }
1739

    
1740
    BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
1741

    
1742
    err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
1743

    
1744
    v9fs_open_post_lstat(s, vs, err);
1745
    return;
1746
out:
1747
    complete_pdu(s, pdu, err);
1748
    qemu_free(vs);
1749
}
1750

    
1751
static void v9fs_post_lcreate(V9fsState *s, V9fsLcreateState *vs, int err)
1752
{
1753
    if (err == 0) {
1754
        v9fs_string_copy(&vs->fidp->path, &vs->fullname);
1755
        stat_to_qid(&vs->stbuf, &vs->qid);
1756
        vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid,
1757
                &vs->iounit);
1758
        err = vs->offset;
1759
    } else {
1760
        vs->fidp->fid_type = P9_FID_NONE;
1761
        err = -errno;
1762
        if (vs->fidp->fs.fd > 0) {
1763
            close(vs->fidp->fs.fd);
1764
        }
1765
    }
1766

    
1767
    complete_pdu(s, vs->pdu, err);
1768
    v9fs_string_free(&vs->name);
1769
    v9fs_string_free(&vs->fullname);
1770
    qemu_free(vs);
1771
}
1772

    
1773
static void v9fs_lcreate_post_get_iounit(V9fsState *s, V9fsLcreateState *vs,
1774
        int err)
1775
{
1776
    if (err) {
1777
        err = -errno;
1778
        goto out;
1779
    }
1780
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
1781

    
1782
out:
1783
    v9fs_post_lcreate(s, vs, err);
1784
}
1785

    
1786
static void v9fs_lcreate_post_do_open2(V9fsState *s, V9fsLcreateState *vs,
1787
        int err)
1788
{
1789
    if (vs->fidp->fs.fd == -1) {
1790
        err = -errno;
1791
        goto out;
1792
    }
1793
    vs->fidp->fid_type = P9_FID_FILE;
1794
    vs->iounit =  get_iounit(s, &vs->fullname);
1795
    v9fs_lcreate_post_get_iounit(s, vs, err);
1796
    return;
1797

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

    
1802
static void v9fs_lcreate(V9fsState *s, V9fsPDU *pdu)
1803
{
1804
    int32_t dfid, flags, mode;
1805
    gid_t gid;
1806
    V9fsLcreateState *vs;
1807
    ssize_t err = 0;
1808

    
1809
    vs = qemu_malloc(sizeof(*vs));
1810
    vs->pdu = pdu;
1811
    vs->offset = 7;
1812

    
1813
    v9fs_string_init(&vs->fullname);
1814

    
1815
    pdu_unmarshal(vs->pdu, vs->offset, "dsddd", &dfid, &vs->name, &flags,
1816
            &mode, &gid);
1817

    
1818
    vs->fidp = lookup_fid(s, dfid);
1819
    if (vs->fidp == NULL) {
1820
        err = -ENOENT;
1821
        goto out;
1822
    }
1823

    
1824
    v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->fidp->path.data,
1825
             vs->name.data);
1826

    
1827
    /* Ignore direct disk access hint until the server supports it. */
1828
    flags &= ~O_DIRECT;
1829

    
1830
    vs->fidp->fs.fd = v9fs_do_open2(s, vs->fullname.data, vs->fidp->uid,
1831
            gid, flags, mode);
1832
    v9fs_lcreate_post_do_open2(s, vs, err);
1833
    return;
1834

    
1835
out:
1836
    complete_pdu(s, vs->pdu, err);
1837
    v9fs_string_free(&vs->name);
1838
    qemu_free(vs);
1839
}
1840

    
1841
static void v9fs_post_do_fsync(V9fsState *s, V9fsPDU *pdu, int err)
1842
{
1843
    if (err == -1) {
1844
        err = -errno;
1845
    }
1846
    complete_pdu(s, pdu, err);
1847
}
1848

    
1849
static void v9fs_fsync(V9fsState *s, V9fsPDU *pdu)
1850
{
1851
    int32_t fid;
1852
    size_t offset = 7;
1853
    V9fsFidState *fidp;
1854
    int err;
1855

    
1856
    pdu_unmarshal(pdu, offset, "d", &fid);
1857
    fidp = lookup_fid(s, fid);
1858
    if (fidp == NULL) {
1859
        err = -ENOENT;
1860
        v9fs_post_do_fsync(s, pdu, err);
1861
        return;
1862
    }
1863
    err = v9fs_do_fsync(s, fidp->fs.fd);
1864
    v9fs_post_do_fsync(s, pdu, err);
1865
}
1866

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

    
1873
    pdu_unmarshal(pdu, offset, "d", &fid);
1874

    
1875
    err = free_fid(s, fid);
1876
    if (err < 0) {
1877
        goto out;
1878
    }
1879

    
1880
    offset = 7;
1881
    err = offset;
1882
out:
1883
    complete_pdu(s, pdu, err);
1884
}
1885

    
1886
static void v9fs_read_post_readdir(V9fsState *, V9fsReadState *, ssize_t);
1887

    
1888
static void v9fs_read_post_seekdir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1889
{
1890
    if (err) {
1891
        goto out;
1892
    }
1893
    v9fs_stat_free(&vs->v9stat);
1894
    v9fs_string_free(&vs->name);
1895
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
1896
    vs->offset += vs->count;
1897
    err = vs->offset;
1898
out:
1899
    complete_pdu(s, vs->pdu, err);
1900
    qemu_free(vs);
1901
    return;
1902
}
1903

    
1904
static void v9fs_read_post_dir_lstat(V9fsState *s, V9fsReadState *vs,
1905
                                    ssize_t err)
1906
{
1907
    if (err) {
1908
        err = -errno;
1909
        goto out;
1910
    }
1911
    err = stat_to_v9stat(s, &vs->name, &vs->stbuf, &vs->v9stat);
1912
    if (err) {
1913
        goto out;
1914
    }
1915

    
1916
    vs->len = pdu_marshal(vs->pdu, vs->offset + 4 + vs->count, "S",
1917
                            &vs->v9stat);
1918
    if ((vs->len != (vs->v9stat.size + 2)) ||
1919
            ((vs->count + vs->len) > vs->max_count)) {
1920
        v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->dir_pos);
1921
        v9fs_read_post_seekdir(s, vs, err);
1922
        return;
1923
    }
1924
    vs->count += vs->len;
1925
    v9fs_stat_free(&vs->v9stat);
1926
    v9fs_string_free(&vs->name);
1927
    vs->dir_pos = vs->dent->d_off;
1928
    vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
1929
    v9fs_read_post_readdir(s, vs, err);
1930
    return;
1931
out:
1932
    v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->dir_pos);
1933
    v9fs_read_post_seekdir(s, vs, err);
1934
    return;
1935

    
1936
}
1937

    
1938
static void v9fs_read_post_readdir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1939
{
1940
    if (vs->dent) {
1941
        memset(&vs->v9stat, 0, sizeof(vs->v9stat));
1942
        v9fs_string_init(&vs->name);
1943
        v9fs_string_sprintf(&vs->name, "%s/%s", vs->fidp->path.data,
1944
                            vs->dent->d_name);
1945
        err = v9fs_do_lstat(s, &vs->name, &vs->stbuf);
1946
        v9fs_read_post_dir_lstat(s, vs, err);
1947
        return;
1948
    }
1949

    
1950
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
1951
    vs->offset += vs->count;
1952
    err = vs->offset;
1953
    complete_pdu(s, vs->pdu, err);
1954
    qemu_free(vs);
1955
    return;
1956
}
1957

    
1958
static void v9fs_read_post_telldir(V9fsState *s, V9fsReadState *vs, ssize_t err)
1959
{
1960
    vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
1961
    v9fs_read_post_readdir(s, vs, err);
1962
    return;
1963
}
1964

    
1965
static void v9fs_read_post_rewinddir(V9fsState *s, V9fsReadState *vs,
1966
                                       ssize_t err)
1967
{
1968
    vs->dir_pos = v9fs_do_telldir(s, vs->fidp->fs.dir);
1969
    v9fs_read_post_telldir(s, vs, err);
1970
    return;
1971
}
1972

    
1973
static void v9fs_read_post_preadv(V9fsState *s, V9fsReadState *vs, ssize_t err)
1974
{
1975
    if (err  < 0) {
1976
        /* IO error return the error */
1977
        err = -errno;
1978
        goto out;
1979
    }
1980
    vs->total += vs->len;
1981
    vs->sg = adjust_sg(vs->sg, vs->len, &vs->cnt);
1982
    if (vs->total < vs->count && vs->len > 0) {
1983
        do {
1984
            if (0) {
1985
                print_sg(vs->sg, vs->cnt);
1986
            }
1987
            vs->len = v9fs_do_preadv(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
1988
                      vs->off);
1989
            if (vs->len > 0) {
1990
                vs->off += vs->len;
1991
            }
1992
        } while (vs->len == -1 && errno == EINTR);
1993
        if (vs->len == -1) {
1994
            err  = -errno;
1995
        }
1996
        v9fs_read_post_preadv(s, vs, err);
1997
        return;
1998
    }
1999
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->total);
2000
    vs->offset += vs->count;
2001
    err = vs->offset;
2002

    
2003
out:
2004
    complete_pdu(s, vs->pdu, err);
2005
    qemu_free(vs);
2006
}
2007

    
2008
static void v9fs_xattr_read(V9fsState *s, V9fsReadState *vs)
2009
{
2010
    ssize_t err = 0;
2011
    int read_count;
2012
    int64_t xattr_len;
2013

    
2014
    xattr_len = vs->fidp->fs.xattr.len;
2015
    read_count = xattr_len - vs->off;
2016
    if (read_count > vs->count) {
2017
        read_count = vs->count;
2018
    } else if (read_count < 0) {
2019
        /*
2020
         * read beyond XATTR value
2021
         */
2022
        read_count = 0;
2023
    }
2024
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", read_count);
2025
    vs->offset += pdu_pack(vs->pdu, vs->offset,
2026
                           ((char *)vs->fidp->fs.xattr.value) + vs->off,
2027
                           read_count);
2028
    err = vs->offset;
2029
    complete_pdu(s, vs->pdu, err);
2030
    qemu_free(vs);
2031
}
2032

    
2033
static void v9fs_read(V9fsState *s, V9fsPDU *pdu)
2034
{
2035
    int32_t fid;
2036
    V9fsReadState *vs;
2037
    ssize_t err = 0;
2038

    
2039
    vs = qemu_malloc(sizeof(*vs));
2040
    vs->pdu = pdu;
2041
    vs->offset = 7;
2042
    vs->total = 0;
2043
    vs->len = 0;
2044
    vs->count = 0;
2045

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

    
2048
    vs->fidp = lookup_fid(s, fid);
2049
    if (vs->fidp == NULL) {
2050
        err = -EINVAL;
2051
        goto out;
2052
    }
2053

    
2054
    if (vs->fidp->fid_type == P9_FID_DIR) {
2055
        vs->max_count = vs->count;
2056
        vs->count = 0;
2057
        if (vs->off == 0) {
2058
            v9fs_do_rewinddir(s, vs->fidp->fs.dir);
2059
        }
2060
        v9fs_read_post_rewinddir(s, vs, err);
2061
        return;
2062
    } else if (vs->fidp->fid_type == P9_FID_FILE) {
2063
        vs->sg = vs->iov;
2064
        pdu_marshal(vs->pdu, vs->offset + 4, "v", vs->sg, &vs->cnt);
2065
        vs->sg = cap_sg(vs->sg, vs->count, &vs->cnt);
2066
        if (vs->total <= vs->count) {
2067
            vs->len = v9fs_do_preadv(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2068
                                    vs->off);
2069
            if (vs->len > 0) {
2070
                vs->off += vs->len;
2071
            }
2072
            err = vs->len;
2073
            v9fs_read_post_preadv(s, vs, err);
2074
        }
2075
        return;
2076
    } else if (vs->fidp->fid_type == P9_FID_XATTR) {
2077
        v9fs_xattr_read(s, vs);
2078
        return;
2079
    } else {
2080
        err = -EINVAL;
2081
    }
2082
out:
2083
    complete_pdu(s, pdu, err);
2084
    qemu_free(vs);
2085
}
2086

    
2087
typedef struct V9fsReadDirState {
2088
    V9fsPDU *pdu;
2089
    V9fsFidState *fidp;
2090
    V9fsQID qid;
2091
    off_t saved_dir_pos;
2092
    struct dirent *dent;
2093
    int32_t count;
2094
    int32_t max_count;
2095
    size_t offset;
2096
    int64_t initial_offset;
2097
    V9fsString name;
2098
} V9fsReadDirState;
2099

    
2100
static void v9fs_readdir_post_seekdir(V9fsState *s, V9fsReadDirState *vs)
2101
{
2102
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
2103
    vs->offset += vs->count;
2104
    complete_pdu(s, vs->pdu, vs->offset);
2105
    qemu_free(vs);
2106
    return;
2107
}
2108

    
2109
/* Size of each dirent on the wire: size of qid (13) + size of offset (8)
2110
 * size of type (1) + size of name.size (2) + strlen(name.data)
2111
 */
2112
#define V9_READDIR_DATA_SZ (24 + strlen(vs->name.data))
2113

    
2114
static void v9fs_readdir_post_readdir(V9fsState *s, V9fsReadDirState *vs)
2115
{
2116
    int len;
2117
    size_t size;
2118

    
2119
    if (vs->dent) {
2120
        v9fs_string_init(&vs->name);
2121
        v9fs_string_sprintf(&vs->name, "%s", vs->dent->d_name);
2122

    
2123
        if ((vs->count + V9_READDIR_DATA_SZ) > vs->max_count) {
2124
            /* Ran out of buffer. Set dir back to old position and return */
2125
            v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->saved_dir_pos);
2126
            v9fs_readdir_post_seekdir(s, vs);
2127
            return;
2128
        }
2129

    
2130
        /* Fill up just the path field of qid because the client uses
2131
         * only that. To fill the entire qid structure we will have
2132
         * to stat each dirent found, which is expensive
2133
         */
2134
        size = MIN(sizeof(vs->dent->d_ino), sizeof(vs->qid.path));
2135
        memcpy(&vs->qid.path, &vs->dent->d_ino, size);
2136
        /* Fill the other fields with dummy values */
2137
        vs->qid.type = 0;
2138
        vs->qid.version = 0;
2139

    
2140
        len = pdu_marshal(vs->pdu, vs->offset+4+vs->count, "Qqbs",
2141
                              &vs->qid, vs->dent->d_off,
2142
                              vs->dent->d_type, &vs->name);
2143
        vs->count += len;
2144
        v9fs_string_free(&vs->name);
2145
        vs->saved_dir_pos = vs->dent->d_off;
2146
        vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
2147
        v9fs_readdir_post_readdir(s, vs);
2148
        return;
2149
    }
2150

    
2151
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->count);
2152
    vs->offset += vs->count;
2153
    complete_pdu(s, vs->pdu, vs->offset);
2154
    qemu_free(vs);
2155
    return;
2156
}
2157

    
2158
static void v9fs_readdir_post_telldir(V9fsState *s, V9fsReadDirState *vs)
2159
{
2160
    vs->dent = v9fs_do_readdir(s, vs->fidp->fs.dir);
2161
    v9fs_readdir_post_readdir(s, vs);
2162
    return;
2163
}
2164

    
2165
static void v9fs_readdir_post_setdir(V9fsState *s, V9fsReadDirState *vs)
2166
{
2167
    vs->saved_dir_pos = v9fs_do_telldir(s, vs->fidp->fs.dir);
2168
    v9fs_readdir_post_telldir(s, vs);
2169
    return;
2170
}
2171

    
2172
static void v9fs_readdir(V9fsState *s, V9fsPDU *pdu)
2173
{
2174
    int32_t fid;
2175
    V9fsReadDirState *vs;
2176
    ssize_t err = 0;
2177
    size_t offset = 7;
2178

    
2179
    vs = qemu_malloc(sizeof(*vs));
2180
    vs->pdu = pdu;
2181
    vs->offset = 7;
2182
    vs->count = 0;
2183

    
2184
    pdu_unmarshal(vs->pdu, offset, "dqd", &fid, &vs->initial_offset,
2185
                                                        &vs->max_count);
2186

    
2187
    vs->fidp = lookup_fid(s, fid);
2188
    if (vs->fidp == NULL || !(vs->fidp->fs.dir)) {
2189
        err = -EINVAL;
2190
        goto out;
2191
    }
2192

    
2193
    if (vs->initial_offset == 0) {
2194
        v9fs_do_rewinddir(s, vs->fidp->fs.dir);
2195
    } else {
2196
        v9fs_do_seekdir(s, vs->fidp->fs.dir, vs->initial_offset);
2197
    }
2198

    
2199
    v9fs_readdir_post_setdir(s, vs);
2200
    return;
2201

    
2202
out:
2203
    complete_pdu(s, pdu, err);
2204
    qemu_free(vs);
2205
    return;
2206
}
2207

    
2208
static void v9fs_write_post_pwritev(V9fsState *s, V9fsWriteState *vs,
2209
                                   ssize_t err)
2210
{
2211
    if (err  < 0) {
2212
        /* IO error return the error */
2213
        err = -errno;
2214
        goto out;
2215
    }
2216
    vs->total += vs->len;
2217
    vs->sg = adjust_sg(vs->sg, vs->len, &vs->cnt);
2218
    if (vs->total < vs->count && vs->len > 0) {
2219
        do {
2220
            if (0) {
2221
                print_sg(vs->sg, vs->cnt);
2222
            }
2223
            vs->len = v9fs_do_pwritev(s, vs->fidp->fs.fd, vs->sg, vs->cnt,
2224
                      vs->off);
2225
            if (vs->len > 0) {
2226
                vs->off += vs->len;
2227
            }
2228
        } while (vs->len == -1 && errno == EINTR);
2229
        if (vs->len == -1) {
2230
            err  = -errno;
2231
        }
2232
        v9fs_write_post_pwritev(s, vs, err);
2233
        return;
2234
    }
2235
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", vs->total);
2236
    err = vs->offset;
2237
out:
2238
    complete_pdu(s, vs->pdu, err);
2239
    qemu_free(vs);
2240
}
2241

    
2242
static void v9fs_xattr_write(V9fsState *s, V9fsWriteState *vs)
2243
{
2244
    int i, to_copy;
2245
    ssize_t err = 0;
2246
    int write_count;
2247
    int64_t xattr_len;
2248

    
2249
    xattr_len = vs->fidp->fs.xattr.len;
2250
    write_count = xattr_len - vs->off;
2251
    if (write_count > vs->count) {
2252
        write_count = vs->count;
2253
    } else if (write_count < 0) {
2254
        /*
2255
         * write beyond XATTR value len specified in
2256
         * xattrcreate
2257
         */
2258
        err = -ENOSPC;
2259
        goto out;
2260
    }
2261
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "d", write_count);
2262
    err = vs->offset;
2263
    vs->fidp->fs.xattr.copied_len += write_count;
2264
    /*
2265
     * Now copy the content from sg list
2266
     */
2267
    for (i = 0; i < vs->cnt; i++) {
2268
        if (write_count > vs->sg[i].iov_len) {
2269
            to_copy = vs->sg[i].iov_len;
2270
        } else {
2271
            to_copy = write_count;
2272
        }
2273
        memcpy((char *)vs->fidp->fs.xattr.value + vs->off,
2274
               vs->sg[i].iov_base, to_copy);
2275
        /* updating vs->off since we are not using below */
2276
        vs->off += to_copy;
2277
        write_count -= to_copy;
2278
    }
2279
out:
2280
    complete_pdu(s, vs->pdu, err);
2281
    qemu_free(vs);
2282
}
2283

    
2284
static void v9fs_write(V9fsState *s, V9fsPDU *pdu)
2285
{
2286
    int32_t fid;
2287
    V9fsWriteState *vs;
2288
    ssize_t err;
2289

    
2290
    vs = qemu_malloc(sizeof(*vs));
2291

    
2292
    vs->pdu = pdu;
2293
    vs->offset = 7;
2294
    vs->sg = vs->iov;
2295
    vs->total = 0;
2296
    vs->len = 0;
2297

    
2298
    pdu_unmarshal(vs->pdu, vs->offset, "dqdv", &fid, &vs->off, &vs->count,
2299
                  vs->sg, &vs->cnt);
2300

    
2301
    vs->fidp = lookup_fid(s, fid);
2302
    if (vs->fidp == NULL) {
2303
        err = -EINVAL;
2304
        goto out;
2305
    }
2306

    
2307
    if (vs->fidp->fid_type == P9_FID_FILE) {
2308
        if (vs->fidp->fs.fd == -1) {
2309
            err = -EINVAL;
2310
            goto out;
2311
        }
2312
    } else if (vs->fidp->fid_type == P9_FID_XATTR) {
2313
        /*
2314
         * setxattr operation
2315
         */
2316
        v9fs_xattr_write(s, vs);
2317
        return;
2318
    } else {
2319
        err = -EINVAL;
2320
        goto out;
2321
    }
2322
    vs->sg = cap_sg(vs->sg, vs->count, &vs->cnt);
2323
    if (vs->total <= vs->count) {
2324
        vs->len = v9fs_do_pwritev(s, vs->fidp->fs.fd, vs->sg, vs->cnt, vs->off);
2325
        if (vs->len > 0) {
2326
            vs->off += vs->len;
2327
        }
2328
        err = vs->len;
2329
        v9fs_write_post_pwritev(s, vs, err);
2330
    }
2331
    return;
2332
out:
2333
    complete_pdu(s, vs->pdu, err);
2334
    qemu_free(vs);
2335
}
2336

    
2337
static void v9fs_create_post_getiounit(V9fsState *s, V9fsCreateState *vs)
2338
{
2339
    int err;
2340
    v9fs_string_copy(&vs->fidp->path, &vs->fullname);
2341
    stat_to_qid(&vs->stbuf, &vs->qid);
2342

    
2343
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Qd", &vs->qid, vs->iounit);
2344
    err = vs->offset;
2345

    
2346
    complete_pdu(s, vs->pdu, err);
2347
    v9fs_string_free(&vs->name);
2348
    v9fs_string_free(&vs->extension);
2349
    v9fs_string_free(&vs->fullname);
2350
    qemu_free(vs);
2351
}
2352

    
2353
static void v9fs_post_create(V9fsState *s, V9fsCreateState *vs, int err)
2354
{
2355
    if (err == 0) {
2356
        vs->iounit = get_iounit(s, &vs->fidp->path);
2357
        v9fs_create_post_getiounit(s, vs);
2358
        return;
2359
    }
2360

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

    
2368
static void v9fs_create_post_perms(V9fsState *s, V9fsCreateState *vs, int err)
2369
{
2370
    if (err) {
2371
        err = -errno;
2372
    }
2373
    v9fs_post_create(s, vs, err);
2374
}
2375

    
2376
static void v9fs_create_post_opendir(V9fsState *s, V9fsCreateState *vs,
2377
                                                                    int err)
2378
{
2379
    if (!vs->fidp->fs.dir) {
2380
        err = -errno;
2381
    }
2382
    vs->fidp->fid_type = P9_FID_DIR;
2383
    v9fs_post_create(s, vs, err);
2384
}
2385

    
2386
static void v9fs_create_post_dir_lstat(V9fsState *s, V9fsCreateState *vs,
2387
                                                                    int err)
2388
{
2389
    if (err) {
2390
        err = -errno;
2391
        goto out;
2392
    }
2393

    
2394
    vs->fidp->fs.dir = v9fs_do_opendir(s, &vs->fullname);
2395
    v9fs_create_post_opendir(s, vs, err);
2396
    return;
2397

    
2398
out:
2399
    v9fs_post_create(s, vs, err);
2400
}
2401

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

    
2409
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2410
    v9fs_create_post_dir_lstat(s, vs, err);
2411
    return;
2412

    
2413
out:
2414
    v9fs_post_create(s, vs, err);
2415
}
2416

    
2417
static void v9fs_create_post_fstat(V9fsState *s, V9fsCreateState *vs, int err)
2418
{
2419
    if (err) {
2420
        vs->fidp->fid_type = P9_FID_NONE;
2421
        close(vs->fidp->fs.fd);
2422
        err = -errno;
2423
    }
2424
    v9fs_post_create(s, vs, err);
2425
    return;
2426
}
2427

    
2428
static void v9fs_create_post_open2(V9fsState *s, V9fsCreateState *vs, int err)
2429
{
2430
    if (vs->fidp->fs.fd == -1) {
2431
        err = -errno;
2432
        goto out;
2433
    }
2434
    vs->fidp->fid_type = P9_FID_FILE;
2435
    err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
2436
    v9fs_create_post_fstat(s, vs, err);
2437

    
2438
    return;
2439

    
2440
out:
2441
    v9fs_post_create(s, vs, err);
2442

    
2443
}
2444

    
2445
static void v9fs_create_post_lstat(V9fsState *s, V9fsCreateState *vs, int err)
2446
{
2447

    
2448
    if (err == 0 || errno != ENOENT) {
2449
        err = -errno;
2450
        goto out;
2451
    }
2452

    
2453
    if (vs->perm & P9_STAT_MODE_DIR) {
2454
        err = v9fs_do_mkdir(s, vs->fullname.data, vs->perm & 0777,
2455
                vs->fidp->uid, -1);
2456
        v9fs_create_post_mkdir(s, vs, err);
2457
    } else if (vs->perm & P9_STAT_MODE_SYMLINK) {
2458
        err = v9fs_do_symlink(s, vs->fidp, vs->extension.data,
2459
                vs->fullname.data, -1);
2460
        v9fs_create_post_perms(s, vs, err);
2461
    } else if (vs->perm & P9_STAT_MODE_LINK) {
2462
        int32_t nfid = atoi(vs->extension.data);
2463
        V9fsFidState *nfidp = lookup_fid(s, nfid);
2464
        if (nfidp == NULL) {
2465
            err = -errno;
2466
            v9fs_post_create(s, vs, err);
2467
        }
2468
        err = v9fs_do_link(s, &nfidp->path, &vs->fullname);
2469
        v9fs_create_post_perms(s, vs, err);
2470
    } else if (vs->perm & P9_STAT_MODE_DEVICE) {
2471
        char ctype;
2472
        uint32_t major, minor;
2473
        mode_t nmode = 0;
2474

    
2475
        if (sscanf(vs->extension.data, "%c %u %u", &ctype, &major,
2476
                                        &minor) != 3) {
2477
            err = -errno;
2478
            v9fs_post_create(s, vs, err);
2479
        }
2480

    
2481
        switch (ctype) {
2482
        case 'c':
2483
            nmode = S_IFCHR;
2484
            break;
2485
        case 'b':
2486
            nmode = S_IFBLK;
2487
            break;
2488
        default:
2489
            err = -EIO;
2490
            v9fs_post_create(s, vs, err);
2491
        }
2492

    
2493
        nmode |= vs->perm & 0777;
2494
        err = v9fs_do_mknod(s, vs->fullname.data, nmode,
2495
                makedev(major, minor), vs->fidp->uid, -1);
2496
        v9fs_create_post_perms(s, vs, err);
2497
    } else if (vs->perm & P9_STAT_MODE_NAMED_PIPE) {
2498
        err = v9fs_do_mknod(s, vs->fullname.data, S_IFIFO | (vs->perm & 0777),
2499
                0, vs->fidp->uid, -1);
2500
        v9fs_post_create(s, vs, err);
2501
    } else if (vs->perm & P9_STAT_MODE_SOCKET) {
2502
        err = v9fs_do_mknod(s, vs->fullname.data, S_IFSOCK | (vs->perm & 0777),
2503
                0, vs->fidp->uid, -1);
2504
        v9fs_post_create(s, vs, err);
2505
    } else {
2506
        vs->fidp->fs.fd = v9fs_do_open2(s, vs->fullname.data, vs->fidp->uid,
2507
                -1, omode_to_uflags(vs->mode)|O_CREAT, vs->perm);
2508

    
2509
        v9fs_create_post_open2(s, vs, err);
2510
    }
2511

    
2512
    return;
2513

    
2514
out:
2515
    v9fs_post_create(s, vs, err);
2516
}
2517

    
2518
static void v9fs_create(V9fsState *s, V9fsPDU *pdu)
2519
{
2520
    int32_t fid;
2521
    V9fsCreateState *vs;
2522
    int err = 0;
2523

    
2524
    vs = qemu_malloc(sizeof(*vs));
2525
    vs->pdu = pdu;
2526
    vs->offset = 7;
2527

    
2528
    v9fs_string_init(&vs->fullname);
2529

    
2530
    pdu_unmarshal(vs->pdu, vs->offset, "dsdbs", &fid, &vs->name,
2531
                                &vs->perm, &vs->mode, &vs->extension);
2532

    
2533
    vs->fidp = lookup_fid(s, fid);
2534
    if (vs->fidp == NULL) {
2535
        err = -EINVAL;
2536
        goto out;
2537
    }
2538

    
2539
    v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->fidp->path.data,
2540
                                                        vs->name.data);
2541

    
2542
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2543
    v9fs_create_post_lstat(s, vs, err);
2544
    return;
2545

    
2546
out:
2547
    complete_pdu(s, vs->pdu, err);
2548
    v9fs_string_free(&vs->name);
2549
    v9fs_string_free(&vs->extension);
2550
    qemu_free(vs);
2551
}
2552

    
2553
static void v9fs_post_symlink(V9fsState *s, V9fsSymlinkState *vs, int err)
2554
{
2555
    if (err == 0) {
2556
        stat_to_qid(&vs->stbuf, &vs->qid);
2557
        vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
2558
        err = vs->offset;
2559
    } else {
2560
        err = -errno;
2561
    }
2562
    complete_pdu(s, vs->pdu, err);
2563
    v9fs_string_free(&vs->name);
2564
    v9fs_string_free(&vs->symname);
2565
    v9fs_string_free(&vs->fullname);
2566
    qemu_free(vs);
2567
}
2568

    
2569
static void v9fs_symlink_post_do_symlink(V9fsState *s, V9fsSymlinkState *vs,
2570
        int err)
2571
{
2572
    if (err) {
2573
        goto out;
2574
    }
2575
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
2576
out:
2577
    v9fs_post_symlink(s, vs, err);
2578
}
2579

    
2580
static void v9fs_symlink(V9fsState *s, V9fsPDU *pdu)
2581
{
2582
    int32_t dfid;
2583
    V9fsSymlinkState *vs;
2584
    int err = 0;
2585
    gid_t gid;
2586

    
2587
    vs = qemu_malloc(sizeof(*vs));
2588
    vs->pdu = pdu;
2589
    vs->offset = 7;
2590

    
2591
    v9fs_string_init(&vs->fullname);
2592

    
2593
    pdu_unmarshal(vs->pdu, vs->offset, "dssd", &dfid, &vs->name,
2594
            &vs->symname, &gid);
2595

    
2596
    vs->dfidp = lookup_fid(s, dfid);
2597
    if (vs->dfidp == NULL) {
2598
        err = -EINVAL;
2599
        goto out;
2600
    }
2601

    
2602
    v9fs_string_sprintf(&vs->fullname, "%s/%s", vs->dfidp->path.data,
2603
            vs->name.data);
2604
    err = v9fs_do_symlink(s, vs->dfidp, vs->symname.data,
2605
            vs->fullname.data, gid);
2606
    v9fs_symlink_post_do_symlink(s, vs, err);
2607
    return;
2608

    
2609
out:
2610
    complete_pdu(s, vs->pdu, err);
2611
    v9fs_string_free(&vs->name);
2612
    v9fs_string_free(&vs->symname);
2613
    qemu_free(vs);
2614
}
2615

    
2616
static void v9fs_flush(V9fsState *s, V9fsPDU *pdu)
2617
{
2618
    /* A nop call with no return */
2619
    complete_pdu(s, pdu, 7);
2620
}
2621

    
2622
static void v9fs_link(V9fsState *s, V9fsPDU *pdu)
2623
{
2624
    int32_t dfid, oldfid;
2625
    V9fsFidState *dfidp, *oldfidp;
2626
    V9fsString name, fullname;
2627
    size_t offset = 7;
2628
    int err = 0;
2629

    
2630
    v9fs_string_init(&fullname);
2631

    
2632
    pdu_unmarshal(pdu, offset, "dds", &dfid, &oldfid, &name);
2633

    
2634
    dfidp = lookup_fid(s, dfid);
2635
    if (dfidp == NULL) {
2636
        err = -errno;
2637
        goto out;
2638
    }
2639

    
2640
    oldfidp = lookup_fid(s, oldfid);
2641
    if (oldfidp == NULL) {
2642
        err = -errno;
2643
        goto out;
2644
    }
2645

    
2646
    v9fs_string_sprintf(&fullname, "%s/%s", dfidp->path.data, name.data);
2647
    err = offset;
2648
    err = v9fs_do_link(s, &oldfidp->path, &fullname);
2649
    if (err) {
2650
        err = -errno;
2651
    }
2652
    v9fs_string_free(&fullname);
2653

    
2654
out:
2655
    v9fs_string_free(&name);
2656
    complete_pdu(s, pdu, err);
2657
}
2658

    
2659
static void v9fs_remove_post_remove(V9fsState *s, V9fsRemoveState *vs,
2660
                                                                int err)
2661
{
2662
    if (err < 0) {
2663
        err = -errno;
2664
    } else {
2665
        err = vs->offset;
2666
    }
2667

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

    
2671
    complete_pdu(s, vs->pdu, err);
2672
    qemu_free(vs);
2673
}
2674

    
2675
static void v9fs_remove(V9fsState *s, V9fsPDU *pdu)
2676
{
2677
    int32_t fid;
2678
    V9fsRemoveState *vs;
2679
    int err = 0;
2680

    
2681
    vs = qemu_malloc(sizeof(*vs));
2682
    vs->pdu = pdu;
2683
    vs->offset = 7;
2684

    
2685
    pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
2686

    
2687
    vs->fidp = lookup_fid(s, fid);
2688
    if (vs->fidp == NULL) {
2689
        err = -EINVAL;
2690
        goto out;
2691
    }
2692

    
2693
    err = v9fs_do_remove(s, &vs->fidp->path);
2694
    v9fs_remove_post_remove(s, vs, err);
2695
    return;
2696

    
2697
out:
2698
    complete_pdu(s, pdu, err);
2699
    qemu_free(vs);
2700
}
2701

    
2702
static void v9fs_wstat_post_truncate(V9fsState *s, V9fsWstatState *vs, int err)
2703
{
2704
    if (err < 0) {
2705
        goto out;
2706
    }
2707

    
2708
    err = vs->offset;
2709

    
2710
out:
2711
    v9fs_stat_free(&vs->v9stat);
2712
    complete_pdu(s, vs->pdu, err);
2713
    qemu_free(vs);
2714
}
2715

    
2716
static void v9fs_wstat_post_rename(V9fsState *s, V9fsWstatState *vs, int err)
2717
{
2718
    if (err < 0) {
2719
        goto out;
2720
    }
2721
    if (vs->v9stat.length != -1) {
2722
        if (v9fs_do_truncate(s, &vs->fidp->path, vs->v9stat.length) < 0) {
2723
            err = -errno;
2724
        }
2725
    }
2726
    v9fs_wstat_post_truncate(s, vs, err);
2727
    return;
2728

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

    
2735
static int v9fs_complete_rename(V9fsState *s, V9fsRenameState *vs)
2736
{
2737
    int err = 0;
2738
    char *old_name, *new_name;
2739
    char *end;
2740

    
2741
    if (vs->newdirfid != -1) {
2742
        V9fsFidState *dirfidp;
2743
        dirfidp = lookup_fid(s, vs->newdirfid);
2744

    
2745
        if (dirfidp == NULL) {
2746
            err = -ENOENT;
2747
            goto out;
2748
        }
2749

    
2750
        BUG_ON(dirfidp->fid_type != P9_FID_NONE);
2751

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

    
2754
        strcpy(new_name, dirfidp->path.data);
2755
        strcat(new_name, "/");
2756
        strcat(new_name + dirfidp->path.size, vs->name.data);
2757
    } else {
2758
        old_name = vs->fidp->path.data;
2759
        end = strrchr(old_name, '/');
2760
        if (end) {
2761
            end++;
2762
        } else {
2763
            end = old_name;
2764
        }
2765
        new_name = qemu_mallocz(end - old_name + vs->name.size + 1);
2766

    
2767
        strncat(new_name, old_name, end - old_name);
2768
        strncat(new_name + (end - old_name), vs->name.data, vs->name.size);
2769
    }
2770

    
2771
    v9fs_string_free(&vs->name);
2772
    vs->name.data = qemu_strdup(new_name);
2773
    vs->name.size = strlen(new_name);
2774

    
2775
    if (strcmp(new_name, vs->fidp->path.data) != 0) {
2776
        if (v9fs_do_rename(s, &vs->fidp->path, &vs->name)) {
2777
            err = -errno;
2778
        } else {
2779
            V9fsFidState *fidp;
2780
            /*
2781
            * Fixup fid's pointing to the old name to
2782
            * start pointing to the new name
2783
            */
2784
            for (fidp = s->fid_list; fidp; fidp = fidp->next) {
2785
                if (vs->fidp == fidp) {
2786
                    /*
2787
                    * we replace name of this fid towards the end
2788
                    * so that our below strcmp will work
2789
                    */
2790
                    continue;
2791
                }
2792
                if (!strncmp(vs->fidp->path.data, fidp->path.data,
2793
                    strlen(vs->fidp->path.data))) {
2794
                    /* replace the name */
2795
                    v9fs_fix_path(&fidp->path, &vs->name,
2796
                                  strlen(vs->fidp->path.data));
2797
                }
2798
            }
2799
            v9fs_string_copy(&vs->fidp->path, &vs->name);
2800
        }
2801
    }
2802
out:
2803
    v9fs_string_free(&vs->name);
2804
    return err;
2805
}
2806

    
2807
static void v9fs_rename_post_rename(V9fsState *s, V9fsRenameState *vs, int err)
2808
{
2809
    complete_pdu(s, vs->pdu, err);
2810
    qemu_free(vs);
2811
}
2812

    
2813
static void v9fs_wstat_post_chown(V9fsState *s, V9fsWstatState *vs, int err)
2814
{
2815
    if (err < 0) {
2816
        goto out;
2817
    }
2818

    
2819
    if (vs->v9stat.name.size != 0) {
2820
        V9fsRenameState *vr;
2821

    
2822
        vr = qemu_mallocz(sizeof(V9fsRenameState));
2823
        vr->newdirfid = -1;
2824
        vr->pdu = vs->pdu;
2825
        vr->fidp = vs->fidp;
2826
        vr->offset = vs->offset;
2827
        vr->name.size = vs->v9stat.name.size;
2828
        vr->name.data = qemu_strdup(vs->v9stat.name.data);
2829

    
2830
        err = v9fs_complete_rename(s, vr);
2831
        qemu_free(vr);
2832
    }
2833
    v9fs_wstat_post_rename(s, vs, err);
2834
    return;
2835

    
2836
out:
2837
    v9fs_stat_free(&vs->v9stat);
2838
    complete_pdu(s, vs->pdu, err);
2839
    qemu_free(vs);
2840
}
2841

    
2842
static void v9fs_rename(V9fsState *s, V9fsPDU *pdu)
2843
{
2844
    int32_t fid;
2845
    V9fsRenameState *vs;
2846
    ssize_t err = 0;
2847

    
2848
    vs = qemu_malloc(sizeof(*vs));
2849
    vs->pdu = pdu;
2850
    vs->offset = 7;
2851

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

    
2854
    vs->fidp = lookup_fid(s, fid);
2855
    if (vs->fidp == NULL) {
2856
        err = -ENOENT;
2857
        goto out;
2858
    }
2859

    
2860
    BUG_ON(vs->fidp->fid_type != P9_FID_NONE);
2861

    
2862
    err = v9fs_complete_rename(s, vs);
2863
    v9fs_rename_post_rename(s, vs, err);
2864
    return;
2865
out:
2866
    complete_pdu(s, vs->pdu, err);
2867
    qemu_free(vs);
2868
}
2869

    
2870
static void v9fs_wstat_post_utime(V9fsState *s, V9fsWstatState *vs, int err)
2871
{
2872
    if (err < 0) {
2873
        goto out;
2874
    }
2875

    
2876
    if (vs->v9stat.n_gid != -1 || vs->v9stat.n_uid != -1) {
2877
        if (v9fs_do_chown(s, &vs->fidp->path, vs->v9stat.n_uid,
2878
                    vs->v9stat.n_gid)) {
2879
            err = -errno;
2880
        }
2881
    }
2882
    v9fs_wstat_post_chown(s, vs, err);
2883
    return;
2884

    
2885
out:
2886
    v9fs_stat_free(&vs->v9stat);
2887
    complete_pdu(s, vs->pdu, err);
2888
    qemu_free(vs);
2889
}
2890

    
2891
static void v9fs_wstat_post_chmod(V9fsState *s, V9fsWstatState *vs, int err)
2892
{
2893
    if (err < 0) {
2894
        goto out;
2895
    }
2896

    
2897
    if (vs->v9stat.mtime != -1 || vs->v9stat.atime != -1) {
2898
        struct timespec times[2];
2899
        if (vs->v9stat.atime != -1) {
2900
            times[0].tv_sec = vs->v9stat.atime;
2901
            times[0].tv_nsec = 0;
2902
        } else {
2903
            times[0].tv_nsec = UTIME_OMIT;
2904
        }
2905
        if (vs->v9stat.mtime != -1) {
2906
            times[1].tv_sec = vs->v9stat.mtime;
2907
            times[1].tv_nsec = 0;
2908
        } else {
2909
            times[1].tv_nsec = UTIME_OMIT;
2910
        }
2911

    
2912
        if (v9fs_do_utimensat(s, &vs->fidp->path, times)) {
2913
            err = -errno;
2914
        }
2915
    }
2916

    
2917
    v9fs_wstat_post_utime(s, vs, err);
2918
    return;
2919

    
2920
out:
2921
    v9fs_stat_free(&vs->v9stat);
2922
    complete_pdu(s, vs->pdu, err);
2923
    qemu_free(vs);
2924
}
2925

    
2926
static void v9fs_wstat_post_fsync(V9fsState *s, V9fsWstatState *vs, int err)
2927
{
2928
    if (err == -1) {
2929
        err = -errno;
2930
    }
2931
    v9fs_stat_free(&vs->v9stat);
2932
    complete_pdu(s, vs->pdu, err);
2933
    qemu_free(vs);
2934
}
2935

    
2936
static void v9fs_wstat_post_lstat(V9fsState *s, V9fsWstatState *vs, int err)
2937
{
2938
    uint32_t v9_mode;
2939

    
2940
    if (err == -1) {
2941
        err = -errno;
2942
        goto out;
2943
    }
2944

    
2945
    v9_mode = stat_to_v9mode(&vs->stbuf);
2946

    
2947
    if ((vs->v9stat.mode & P9_STAT_MODE_TYPE_BITS) !=
2948
        (v9_mode & P9_STAT_MODE_TYPE_BITS)) {
2949
            /* Attempting to change the type */
2950
            err = -EIO;
2951
            goto out;
2952
    }
2953

    
2954
    if (v9fs_do_chmod(s, &vs->fidp->path, v9mode_to_mode(vs->v9stat.mode,
2955
                    &vs->v9stat.extension))) {
2956
            err = -errno;
2957
     }
2958
    v9fs_wstat_post_chmod(s, vs, err);
2959
    return;
2960

    
2961
out:
2962
    v9fs_stat_free(&vs->v9stat);
2963
    complete_pdu(s, vs->pdu, err);
2964
    qemu_free(vs);
2965
}
2966

    
2967
static void v9fs_wstat(V9fsState *s, V9fsPDU *pdu)
2968
{
2969
    int32_t fid;
2970
    V9fsWstatState *vs;
2971
    int err = 0;
2972

    
2973
    vs = qemu_malloc(sizeof(*vs));
2974
    vs->pdu = pdu;
2975
    vs->offset = 7;
2976

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

    
2979
    vs->fidp = lookup_fid(s, fid);
2980
    if (vs->fidp == NULL) {
2981
        err = -EINVAL;
2982
        goto out;
2983
    }
2984

    
2985
    /* do we need to sync the file? */
2986
    if (donttouch_stat(&vs->v9stat)) {
2987
        err = v9fs_do_fsync(s, vs->fidp->fs.fd);
2988
        v9fs_wstat_post_fsync(s, vs, err);
2989
        return;
2990
    }
2991

    
2992
    if (vs->v9stat.mode != -1) {
2993
        err = v9fs_do_lstat(s, &vs->fidp->path, &vs->stbuf);
2994
        v9fs_wstat_post_lstat(s, vs, err);
2995
        return;
2996
    }
2997

    
2998
    v9fs_wstat_post_chmod(s, vs, err);
2999
    return;
3000

    
3001
out:
3002
    v9fs_stat_free(&vs->v9stat);
3003
    complete_pdu(s, vs->pdu, err);
3004
    qemu_free(vs);
3005
}
3006

    
3007
static void v9fs_statfs_post_statfs(V9fsState *s, V9fsStatfsState *vs, int err)
3008
{
3009
    int32_t bsize_factor;
3010

    
3011
    if (err) {
3012
        err = -errno;
3013
        goto out;
3014
    }
3015

    
3016
    /*
3017
     * compute bsize factor based on host file system block size
3018
     * and client msize
3019
     */
3020
    bsize_factor = (s->msize - P9_IOHDRSZ)/vs->stbuf.f_bsize;
3021
    if (!bsize_factor) {
3022
        bsize_factor = 1;
3023
    }
3024
    vs->v9statfs.f_type = vs->stbuf.f_type;
3025
    vs->v9statfs.f_bsize = vs->stbuf.f_bsize;
3026
    vs->v9statfs.f_bsize *= bsize_factor;
3027
    /*
3028
     * f_bsize is adjusted(multiplied) by bsize factor, so we need to
3029
     * adjust(divide) the number of blocks, free blocks and available
3030
     * blocks by bsize factor
3031
     */
3032
    vs->v9statfs.f_blocks = vs->stbuf.f_blocks/bsize_factor;
3033
    vs->v9statfs.f_bfree = vs->stbuf.f_bfree/bsize_factor;
3034
    vs->v9statfs.f_bavail = vs->stbuf.f_bavail/bsize_factor;
3035
    vs->v9statfs.f_files = vs->stbuf.f_files;
3036
    vs->v9statfs.f_ffree = vs->stbuf.f_ffree;
3037
    vs->v9statfs.fsid_val = (unsigned int) vs->stbuf.f_fsid.__val[0] |
3038
                        (unsigned long long)vs->stbuf.f_fsid.__val[1] << 32;
3039
    vs->v9statfs.f_namelen = vs->stbuf.f_namelen;
3040

    
3041
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "ddqqqqqqd",
3042
         vs->v9statfs.f_type, vs->v9statfs.f_bsize, vs->v9statfs.f_blocks,
3043
         vs->v9statfs.f_bfree, vs->v9statfs.f_bavail, vs->v9statfs.f_files,
3044
         vs->v9statfs.f_ffree, vs->v9statfs.fsid_val,
3045
         vs->v9statfs.f_namelen);
3046

    
3047
out:
3048
    complete_pdu(s, vs->pdu, vs->offset);
3049
    qemu_free(vs);
3050
}
3051

    
3052
static void v9fs_statfs(V9fsState *s, V9fsPDU *pdu)
3053
{
3054
    V9fsStatfsState *vs;
3055
    ssize_t err = 0;
3056

    
3057
    vs = qemu_malloc(sizeof(*vs));
3058
    vs->pdu = pdu;
3059
    vs->offset = 7;
3060

    
3061
    memset(&vs->v9statfs, 0, sizeof(vs->v9statfs));
3062

    
3063
    pdu_unmarshal(vs->pdu, vs->offset, "d", &vs->fid);
3064

    
3065
    vs->fidp = lookup_fid(s, vs->fid);
3066
    if (vs->fidp == NULL) {
3067
        err = -ENOENT;
3068
        goto out;
3069
    }
3070

    
3071
    err = v9fs_do_statfs(s, &vs->fidp->path, &vs->stbuf);
3072
    v9fs_statfs_post_statfs(s, vs, err);
3073
    return;
3074

    
3075
out:
3076
    complete_pdu(s, vs->pdu, err);
3077
    qemu_free(vs);
3078
}
3079

    
3080
static void v9fs_mknod_post_lstat(V9fsState *s, V9fsMkState *vs, int err)
3081
{
3082
    if (err == -1) {
3083
        err = -errno;
3084
        goto out;
3085
    }
3086

    
3087
    stat_to_qid(&vs->stbuf, &vs->qid);
3088
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
3089
    err = vs->offset;
3090
out:
3091
    complete_pdu(s, vs->pdu, err);
3092
    v9fs_string_free(&vs->fullname);
3093
    v9fs_string_free(&vs->name);
3094
    qemu_free(vs);
3095
}
3096

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

    
3104
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
3105
    v9fs_mknod_post_lstat(s, vs, err);
3106
    return;
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(V9fsState *s, V9fsPDU *pdu)
3115
{
3116
    int32_t fid;
3117
    V9fsMkState *vs;
3118
    int err = 0;
3119
    V9fsFidState *fidp;
3120
    gid_t gid;
3121
    int mode;
3122
    int major, minor;
3123

    
3124
    vs = qemu_malloc(sizeof(*vs));
3125
    vs->pdu = pdu;
3126
    vs->offset = 7;
3127

    
3128
    v9fs_string_init(&vs->fullname);
3129
    pdu_unmarshal(vs->pdu, vs->offset, "dsdddd", &fid, &vs->name, &mode,
3130
        &major, &minor, &gid);
3131

    
3132
    fidp = lookup_fid(s, fid);
3133
    if (fidp == NULL) {
3134
        err = -ENOENT;
3135
        goto out;
3136
    }
3137

    
3138
    v9fs_string_sprintf(&vs->fullname, "%s/%s", fidp->path.data, vs->name.data);
3139
    err = v9fs_do_mknod(s, vs->fullname.data, mode, makedev(major, minor),
3140
        fidp->uid, gid);
3141
    v9fs_mknod_post_mknod(s, vs, err);
3142
    return;
3143

    
3144
out:
3145
    complete_pdu(s, vs->pdu, err);
3146
    v9fs_string_free(&vs->fullname);
3147
    v9fs_string_free(&vs->name);
3148
    qemu_free(vs);
3149
}
3150

    
3151
/*
3152
 * Implement posix byte range locking code
3153
 * Server side handling of locking code is very simple, because 9p server in
3154
 * QEMU can handle only one client. And most of the lock handling
3155
 * (like conflict, merging) etc is done by the VFS layer itself, so no need to
3156
 * do any thing in * qemu 9p server side lock code path.
3157
 * So when a TLOCK request comes, always return success
3158
 */
3159

    
3160
static void v9fs_lock(V9fsState *s, V9fsPDU *pdu)
3161
{
3162
    int32_t fid, err = 0;
3163
    V9fsLockState *vs;
3164

    
3165
    vs = qemu_mallocz(sizeof(*vs));
3166
    vs->pdu = pdu;
3167
    vs->offset = 7;
3168

    
3169
    vs->flock = qemu_malloc(sizeof(*vs->flock));
3170
    pdu_unmarshal(vs->pdu, vs->offset, "dbdqqds", &fid, &vs->flock->type,
3171
                &vs->flock->flags, &vs->flock->start, &vs->flock->length,
3172
                            &vs->flock->proc_id, &vs->flock->client_id);
3173

    
3174
    vs->status = P9_LOCK_ERROR;
3175

    
3176
    /* We support only block flag now (that too ignored currently) */
3177
    if (vs->flock->flags & ~P9_LOCK_FLAGS_BLOCK) {
3178
        err = -EINVAL;
3179
        goto out;
3180
    }
3181
    vs->fidp = lookup_fid(s, fid);
3182
    if (vs->fidp == NULL) {
3183
        err = -ENOENT;
3184
        goto out;
3185
    }
3186

    
3187
    err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
3188
    if (err < 0) {
3189
        err = -errno;
3190
        goto out;
3191
    }
3192
    vs->status = P9_LOCK_SUCCESS;
3193
out:
3194
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "b", vs->status);
3195
    complete_pdu(s, vs->pdu, err);
3196
    qemu_free(vs->flock);
3197
    qemu_free(vs);
3198
}
3199

    
3200
/*
3201
 * When a TGETLOCK request comes, always return success because all lock
3202
 * handling is done by client's VFS layer.
3203
 */
3204

    
3205
static void v9fs_getlock(V9fsState *s, V9fsPDU *pdu)
3206
{
3207
    int32_t fid, err = 0;
3208
    V9fsGetlockState *vs;
3209

    
3210
    vs = qemu_mallocz(sizeof(*vs));
3211
    vs->pdu = pdu;
3212
    vs->offset = 7;
3213

    
3214
    vs->glock = qemu_malloc(sizeof(*vs->glock));
3215
    pdu_unmarshal(vs->pdu, vs->offset, "dbqqds", &fid, &vs->glock->type,
3216
                &vs->glock->start, &vs->glock->length, &vs->glock->proc_id,
3217
                &vs->glock->client_id);
3218

    
3219
    vs->fidp = lookup_fid(s, fid);
3220
    if (vs->fidp == NULL) {
3221
        err = -ENOENT;
3222
        goto out;
3223
    }
3224

    
3225
    err = v9fs_do_fstat(s, vs->fidp->fs.fd, &vs->stbuf);
3226
    if (err < 0) {
3227
        err = -errno;
3228
        goto out;
3229
    }
3230
    vs->glock->type = F_UNLCK;
3231
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "bqqds", vs->glock->type,
3232
                vs->glock->start, vs->glock->length, vs->glock->proc_id,
3233
                &vs->glock->client_id);
3234
out:
3235
    complete_pdu(s, vs->pdu, err);
3236
    qemu_free(vs->glock);
3237
    qemu_free(vs);
3238
}
3239

    
3240
static void v9fs_mkdir_post_lstat(V9fsState *s, V9fsMkState *vs, int err)
3241
{
3242
    if (err == -1) {
3243
        err = -errno;
3244
        goto out;
3245
    }
3246

    
3247
    stat_to_qid(&vs->stbuf, &vs->qid);
3248
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "Q", &vs->qid);
3249
    err = vs->offset;
3250
out:
3251
    complete_pdu(s, vs->pdu, err);
3252
    v9fs_string_free(&vs->fullname);
3253
    v9fs_string_free(&vs->name);
3254
    qemu_free(vs);
3255
}
3256

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

    
3264
    err = v9fs_do_lstat(s, &vs->fullname, &vs->stbuf);
3265
    v9fs_mkdir_post_lstat(s, vs, err);
3266
    return;
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(V9fsState *s, V9fsPDU *pdu)
3275
{
3276
    int32_t fid;
3277
    V9fsMkState *vs;
3278
    int err = 0;
3279
    V9fsFidState *fidp;
3280
    gid_t gid;
3281
    int mode;
3282

    
3283
    vs = qemu_malloc(sizeof(*vs));
3284
    vs->pdu = pdu;
3285
    vs->offset = 7;
3286

    
3287
    v9fs_string_init(&vs->fullname);
3288
    pdu_unmarshal(vs->pdu, vs->offset, "dsdd", &fid, &vs->name, &mode,
3289
        &gid);
3290

    
3291
    fidp = lookup_fid(s, fid);
3292
    if (fidp == NULL) {
3293
        err = -ENOENT;
3294
        goto out;
3295
    }
3296

    
3297
    v9fs_string_sprintf(&vs->fullname, "%s/%s", fidp->path.data, vs->name.data);
3298
    err = v9fs_do_mkdir(s, vs->fullname.data, mode, fidp->uid, gid);
3299
    v9fs_mkdir_post_mkdir(s, vs, err);
3300
    return;
3301

    
3302
out:
3303
    complete_pdu(s, vs->pdu, err);
3304
    v9fs_string_free(&vs->fullname);
3305
    v9fs_string_free(&vs->name);
3306
    qemu_free(vs);
3307
}
3308

    
3309
static void v9fs_post_xattr_getvalue(V9fsState *s, V9fsXattrState *vs, int err)
3310
{
3311

    
3312
    if (err < 0) {
3313
        err = -errno;
3314
        free_fid(s, vs->xattr_fidp->fid);
3315
        goto out;
3316
    }
3317
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "q", vs->size);
3318
    err = vs->offset;
3319
out:
3320
    complete_pdu(s, vs->pdu, err);
3321
    v9fs_string_free(&vs->name);
3322
    qemu_free(vs);
3323
    return;
3324
}
3325

    
3326
static void v9fs_post_xattr_check(V9fsState *s, V9fsXattrState *vs, ssize_t err)
3327
{
3328
    if (err < 0) {
3329
        err = -errno;
3330
        free_fid(s, vs->xattr_fidp->fid);
3331
        goto out;
3332
    }
3333
    /*
3334
     * Read the xattr value
3335
     */
3336
    vs->xattr_fidp->fs.xattr.len = vs->size;
3337
    vs->xattr_fidp->fid_type = P9_FID_XATTR;
3338
    vs->xattr_fidp->fs.xattr.copied_len = -1;
3339
    if (vs->size) {
3340
        vs->xattr_fidp->fs.xattr.value = qemu_malloc(vs->size);
3341
        err = v9fs_do_lgetxattr(s, &vs->xattr_fidp->path,
3342
                                &vs->name, vs->xattr_fidp->fs.xattr.value,
3343
                                vs->xattr_fidp->fs.xattr.len);
3344
    }
3345
    v9fs_post_xattr_getvalue(s, vs, err);
3346
    return;
3347
out:
3348
    complete_pdu(s, vs->pdu, err);
3349
    v9fs_string_free(&vs->name);
3350
    qemu_free(vs);
3351
}
3352

    
3353
static void v9fs_post_lxattr_getvalue(V9fsState *s,
3354
                                      V9fsXattrState *vs, int err)
3355
{
3356
    if (err < 0) {
3357
        err = -errno;
3358
        free_fid(s, vs->xattr_fidp->fid);
3359
        goto out;
3360
    }
3361
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "q", vs->size);
3362
    err = vs->offset;
3363
out:
3364
    complete_pdu(s, vs->pdu, err);
3365
    v9fs_string_free(&vs->name);
3366
    qemu_free(vs);
3367
    return;
3368
}
3369

    
3370
static void v9fs_post_lxattr_check(V9fsState *s,
3371
                                   V9fsXattrState *vs, ssize_t err)
3372
{
3373
    if (err < 0) {
3374
        err = -errno;
3375
        free_fid(s, vs->xattr_fidp->fid);
3376
        goto out;
3377
    }
3378
    /*
3379
     * Read the xattr value
3380
     */
3381
    vs->xattr_fidp->fs.xattr.len = vs->size;
3382
    vs->xattr_fidp->fid_type = P9_FID_XATTR;
3383
    vs->xattr_fidp->fs.xattr.copied_len = -1;
3384
    if (vs->size) {
3385
        vs->xattr_fidp->fs.xattr.value = qemu_malloc(vs->size);
3386
        err = v9fs_do_llistxattr(s, &vs->xattr_fidp->path,
3387
                                 vs->xattr_fidp->fs.xattr.value,
3388
                                 vs->xattr_fidp->fs.xattr.len);
3389
    }
3390
    v9fs_post_lxattr_getvalue(s, vs, err);
3391
    return;
3392
out:
3393
    complete_pdu(s, vs->pdu, err);
3394
    v9fs_string_free(&vs->name);
3395
    qemu_free(vs);
3396
}
3397

    
3398
static void v9fs_xattrwalk(V9fsState *s, V9fsPDU *pdu)
3399
{
3400
    ssize_t err = 0;
3401
    V9fsXattrState *vs;
3402
    int32_t fid, newfid;
3403

    
3404
    vs = qemu_malloc(sizeof(*vs));
3405
    vs->pdu = pdu;
3406
    vs->offset = 7;
3407

    
3408
    pdu_unmarshal(vs->pdu, vs->offset, "dds", &fid, &newfid, &vs->name);
3409
    vs->file_fidp = lookup_fid(s, fid);
3410
    if (vs->file_fidp == NULL) {
3411
        err = -ENOENT;
3412
        goto out;
3413
    }
3414

    
3415
    vs->xattr_fidp = alloc_fid(s, newfid);
3416
    if (vs->xattr_fidp == NULL) {
3417
        err = -EINVAL;
3418
        goto out;
3419
    }
3420

    
3421
    v9fs_string_copy(&vs->xattr_fidp->path, &vs->file_fidp->path);
3422
    if (vs->name.data[0] == 0) {
3423
        /*
3424
         * listxattr request. Get the size first
3425
         */
3426
        vs->size = v9fs_do_llistxattr(s, &vs->xattr_fidp->path,
3427
                                      NULL, 0);
3428
        if (vs->size < 0) {
3429
            err = vs->size;
3430
        }
3431
        v9fs_post_lxattr_check(s, vs, err);
3432
        return;
3433
    } else {
3434
        /*
3435
         * specific xattr fid. We check for xattr
3436
         * presence also collect the xattr size
3437
         */
3438
        vs->size = v9fs_do_lgetxattr(s, &vs->xattr_fidp->path,
3439
                                     &vs->name, NULL, 0);
3440
        if (vs->size < 0) {
3441
            err = vs->size;
3442
        }
3443
        v9fs_post_xattr_check(s, vs, err);
3444
        return;
3445
    }
3446
out:
3447
    complete_pdu(s, vs->pdu, err);
3448
    v9fs_string_free(&vs->name);
3449
    qemu_free(vs);
3450
}
3451

    
3452
static void v9fs_xattrcreate(V9fsState *s, V9fsPDU *pdu)
3453
{
3454
    int flags;
3455
    int32_t fid;
3456
    ssize_t err = 0;
3457
    V9fsXattrState *vs;
3458

    
3459
    vs = qemu_malloc(sizeof(*vs));
3460
    vs->pdu = pdu;
3461
    vs->offset = 7;
3462

    
3463
    pdu_unmarshal(vs->pdu, vs->offset, "dsqd",
3464
                  &fid, &vs->name, &vs->size, &flags);
3465

    
3466
    vs->file_fidp = lookup_fid(s, fid);
3467
    if (vs->file_fidp == NULL) {
3468
        err = -EINVAL;
3469
        goto out;
3470
    }
3471

    
3472
    /* Make the file fid point to xattr */
3473
    vs->xattr_fidp = vs->file_fidp;
3474
    vs->xattr_fidp->fid_type = P9_FID_XATTR;
3475
    vs->xattr_fidp->fs.xattr.copied_len = 0;
3476
    vs->xattr_fidp->fs.xattr.len = vs->size;
3477
    vs->xattr_fidp->fs.xattr.flags = flags;
3478
    v9fs_string_init(&vs->xattr_fidp->fs.xattr.name);
3479
    v9fs_string_copy(&vs->xattr_fidp->fs.xattr.name, &vs->name);
3480
    if (vs->size)
3481
        vs->xattr_fidp->fs.xattr.value = qemu_malloc(vs->size);
3482
    else
3483
        vs->xattr_fidp->fs.xattr.value = NULL;
3484

    
3485
out:
3486
    complete_pdu(s, vs->pdu, err);
3487
    v9fs_string_free(&vs->name);
3488
    qemu_free(vs);
3489
}
3490

    
3491
static void v9fs_readlink_post_readlink(V9fsState *s, V9fsReadLinkState *vs,
3492
                                                    int err)
3493
{
3494
    if (err < 0) {
3495
        err = -errno;
3496
        goto out;
3497
    }
3498
    vs->offset += pdu_marshal(vs->pdu, vs->offset, "s", &vs->target);
3499
    err = vs->offset;
3500
out:
3501
    complete_pdu(s, vs->pdu, err);
3502
    v9fs_string_free(&vs->target);
3503
    qemu_free(vs);
3504
}
3505

    
3506
static void v9fs_readlink(V9fsState *s, V9fsPDU *pdu)
3507
{
3508
    int32_t fid;
3509
    V9fsReadLinkState *vs;
3510
    int err = 0;
3511
    V9fsFidState *fidp;
3512

    
3513
    vs = qemu_malloc(sizeof(*vs));
3514
    vs->pdu = pdu;
3515
    vs->offset = 7;
3516

    
3517
    pdu_unmarshal(vs->pdu, vs->offset, "d", &fid);
3518

    
3519
    fidp = lookup_fid(s, fid);
3520
    if (fidp == NULL) {
3521
        err = -ENOENT;
3522
        goto out;
3523
    }
3524

    
3525
    v9fs_string_init(&vs->target);
3526
    err = v9fs_do_readlink(s, &fidp->path, &vs->target);
3527
    v9fs_readlink_post_readlink(s, vs, err);
3528
    return;
3529
out:
3530
    complete_pdu(s, vs->pdu, err);
3531
    qemu_free(vs);
3532
}
3533

    
3534
typedef void (pdu_handler_t)(V9fsState *s, V9fsPDU *pdu);
3535

    
3536
static pdu_handler_t *pdu_handlers[] = {
3537
    [P9_TREADDIR] = v9fs_readdir,
3538
    [P9_TSTATFS] = v9fs_statfs,
3539
    [P9_TGETATTR] = v9fs_getattr,
3540
    [P9_TSETATTR] = v9fs_setattr,
3541
    [P9_TXATTRWALK] = v9fs_xattrwalk,
3542
    [P9_TXATTRCREATE] = v9fs_xattrcreate,
3543
    [P9_TMKNOD] = v9fs_mknod,
3544
    [P9_TRENAME] = v9fs_rename,
3545
    [P9_TLOCK] = v9fs_lock,
3546
    [P9_TGETLOCK] = v9fs_getlock,
3547
    [P9_TREADLINK] = v9fs_readlink,
3548
    [P9_TMKDIR] = v9fs_mkdir,
3549
    [P9_TVERSION] = v9fs_version,
3550
    [P9_TLOPEN] = v9fs_open,
3551
    [P9_TATTACH] = v9fs_attach,
3552
    [P9_TSTAT] = v9fs_stat,
3553
    [P9_TWALK] = v9fs_walk,
3554
    [P9_TCLUNK] = v9fs_clunk,
3555
    [P9_TFSYNC] = v9fs_fsync,
3556
    [P9_TOPEN] = v9fs_open,
3557
    [P9_TREAD] = v9fs_read,
3558
#if 0
3559
    [P9_TAUTH] = v9fs_auth,
3560
#endif
3561
    [P9_TFLUSH] = v9fs_flush,
3562
    [P9_TLINK] = v9fs_link,
3563
    [P9_TSYMLINK] = v9fs_symlink,
3564
    [P9_TCREATE] = v9fs_create,
3565
    [P9_TLCREATE] = v9fs_lcreate,
3566
    [P9_TWRITE] = v9fs_write,
3567
    [P9_TWSTAT] = v9fs_wstat,
3568
    [P9_TREMOVE] = v9fs_remove,
3569
};
3570

    
3571
static void submit_pdu(V9fsState *s, V9fsPDU *pdu)
3572
{
3573
    pdu_handler_t *handler;
3574

    
3575
    if (debug_9p_pdu) {
3576
        pprint_pdu(pdu);
3577
    }
3578

    
3579
    BUG_ON(pdu->id >= ARRAY_SIZE(pdu_handlers));
3580

    
3581
    handler = pdu_handlers[pdu->id];
3582
    BUG_ON(handler == NULL);
3583

    
3584
    handler(s, pdu);
3585
}
3586

    
3587
static void handle_9p_output(VirtIODevice *vdev, VirtQueue *vq)
3588
{
3589
    V9fsState *s = (V9fsState *)vdev;
3590
    V9fsPDU *pdu;
3591
    ssize_t len;
3592

    
3593
    while ((pdu = alloc_pdu(s)) &&
3594
            (len = virtqueue_pop(vq, &pdu->elem)) != 0) {
3595
        uint8_t *ptr;
3596

    
3597
        BUG_ON(pdu->elem.out_num == 0 || pdu->elem.in_num == 0);
3598
        BUG_ON(pdu->elem.out_sg[0].iov_len < 7);
3599

    
3600
        ptr = pdu->elem.out_sg[0].iov_base;
3601

    
3602
        memcpy(&pdu->size, ptr, 4);
3603
        pdu->id = ptr[4];
3604
        memcpy(&pdu->tag, ptr + 5, 2);
3605

    
3606
        submit_pdu(s, pdu);
3607
    }
3608

    
3609
    free_pdu(s, pdu);
3610
}
3611

    
3612
static uint32_t virtio_9p_get_features(VirtIODevice *vdev, uint32_t features)
3613
{
3614
    features |= 1 << VIRTIO_9P_MOUNT_TAG;
3615
    return features;
3616
}
3617

    
3618
static V9fsState *to_virtio_9p(VirtIODevice *vdev)
3619
{
3620
    return (V9fsState *)vdev;
3621
}
3622

    
3623
static void virtio_9p_get_config(VirtIODevice *vdev, uint8_t *config)
3624
{
3625
    struct virtio_9p_config *cfg;
3626
    V9fsState *s = to_virtio_9p(vdev);
3627

    
3628
    cfg = qemu_mallocz(sizeof(struct virtio_9p_config) +
3629
                        s->tag_len);
3630
    stw_raw(&cfg->tag_len, s->tag_len);
3631
    memcpy(cfg->tag, s->tag, s->tag_len);
3632
    memcpy(config, cfg, s->config_size);
3633
    qemu_free(cfg);
3634
}
3635

    
3636
VirtIODevice *virtio_9p_init(DeviceState *dev, V9fsConf *conf)
3637
 {
3638
    V9fsState *s;
3639
    int i, len;
3640
    struct stat stat;
3641
    FsTypeEntry *fse;
3642

    
3643

    
3644
    s = (V9fsState *)virtio_common_init("virtio-9p",
3645
                                    VIRTIO_ID_9P,
3646
                                    sizeof(struct virtio_9p_config)+
3647
                                    MAX_TAG_LEN,
3648
                                    sizeof(V9fsState));
3649

    
3650
    /* initialize pdu allocator */
3651
    QLIST_INIT(&s->free_list);
3652
    for (i = 0; i < (MAX_REQ - 1); i++) {
3653
        QLIST_INSERT_HEAD(&s->free_list, &s->pdus[i], next);
3654
    }
3655

    
3656
    s->vq = virtio_add_queue(&s->vdev, MAX_REQ, handle_9p_output);
3657

    
3658
    fse = get_fsdev_fsentry(conf->fsdev_id);
3659

    
3660
    if (!fse) {
3661
        /* We don't have a fsdev identified by fsdev_id */
3662
        fprintf(stderr, "Virtio-9p device couldn't find fsdev with the "
3663
                "id = %s\n", conf->fsdev_id ? conf->fsdev_id : "NULL");
3664
        exit(1);
3665
    }
3666

    
3667
    if (!fse->path || !conf->tag) {
3668
        /* we haven't specified a mount_tag or the path */
3669
        fprintf(stderr, "fsdev with id %s needs path "
3670
                "and Virtio-9p device needs mount_tag arguments\n",
3671
                conf->fsdev_id);
3672
        exit(1);
3673
    }
3674

    
3675
    if (!strcmp(fse->security_model, "passthrough")) {
3676
        /* Files on the Fileserver set to client user credentials */
3677
        s->ctx.fs_sm = SM_PASSTHROUGH;
3678
        s->ctx.xops = passthrough_xattr_ops;
3679
    } else if (!strcmp(fse->security_model, "mapped")) {
3680
        /* Files on the fileserver are set to QEMU credentials.
3681
         * Client user credentials are saved in extended attributes.
3682
         */
3683
        s->ctx.fs_sm = SM_MAPPED;
3684
        s->ctx.xops = mapped_xattr_ops;
3685
    } else if (!strcmp(fse->security_model, "none")) {
3686
        /*
3687
         * Files on the fileserver are set to QEMU credentials.
3688
         */
3689
        s->ctx.fs_sm = SM_NONE;
3690
        s->ctx.xops = none_xattr_ops;
3691
    } else {
3692
        fprintf(stderr, "Default to security_model=none. You may want"
3693
                " enable advanced security model using "
3694
                "security option:\n\t security_model=passthrough \n\t "
3695
                "security_model=mapped\n");
3696
        s->ctx.fs_sm = SM_NONE;
3697
        s->ctx.xops = none_xattr_ops;
3698
    }
3699

    
3700
    if (lstat(fse->path, &stat)) {
3701
        fprintf(stderr, "share path %s does not exist\n", fse->path);
3702
        exit(1);
3703
    } else if (!S_ISDIR(stat.st_mode)) {
3704
        fprintf(stderr, "share path %s is not a directory \n", fse->path);
3705
        exit(1);
3706
    }
3707

    
3708
    s->ctx.fs_root = qemu_strdup(fse->path);
3709
    len = strlen(conf->tag);
3710
    if (len > MAX_TAG_LEN) {
3711
        len = MAX_TAG_LEN;
3712
    }
3713
    /* s->tag is non-NULL terminated string */
3714
    s->tag = qemu_malloc(len);
3715
    memcpy(s->tag, conf->tag, len);
3716
    s->tag_len = len;
3717
    s->ctx.uid = -1;
3718

    
3719
    s->ops = fse->ops;
3720
    s->vdev.get_features = virtio_9p_get_features;
3721
    s->config_size = sizeof(struct virtio_9p_config) +
3722
                        s->tag_len;
3723
    s->vdev.get_config = virtio_9p_get_config;
3724

    
3725
    return &s->vdev;
3726
}