Statistics
| Branch: | Revision:

root / block.c @ fbb7b4e0

History | View | Annotate | Download (43.9 kB)

1
/*
2
 * QEMU System Emulator block driver
3
 *
4
 * Copyright (c) 2003 Fabrice Bellard
5
 *
6
 * Permission is hereby granted, free of charge, to any person obtaining a copy
7
 * of this software and associated documentation files (the "Software"), to deal
8
 * in the Software without restriction, including without limitation the rights
9
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10
 * copies of the Software, and to permit persons to whom the Software is
11
 * furnished to do so, subject to the following conditions:
12
 *
13
 * The above copyright notice and this permission notice shall be included in
14
 * all copies or substantial portions of the Software.
15
 *
16
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22
 * THE SOFTWARE.
23
 */
24
#include "config-host.h"
25
#ifdef HOST_BSD
26
/* include native header before sys-queue.h */
27
#include <sys/queue.h>
28
#endif
29

    
30
#include "qemu-common.h"
31
#include "monitor.h"
32
#include "block_int.h"
33

    
34
#ifdef HOST_BSD
35
#include <sys/types.h>
36
#include <sys/stat.h>
37
#include <sys/ioctl.h>
38
#ifndef __DragonFly__
39
#include <sys/disk.h>
40
#endif
41
#endif
42

    
43
#ifdef _WIN32
44
#include <windows.h>
45
#endif
46

    
47
#define SECTOR_BITS 9
48
#define SECTOR_SIZE (1 << SECTOR_BITS)
49

    
50
typedef struct BlockDriverAIOCBSync {
51
    BlockDriverAIOCB common;
52
    QEMUBH *bh;
53
    int ret;
54
    /* vector translation state */
55
    QEMUIOVector *qiov;
56
    uint8_t *bounce;
57
    int is_write;
58
} BlockDriverAIOCBSync;
59

    
60
static BlockDriverAIOCB *bdrv_aio_readv_em(BlockDriverState *bs,
61
        int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
62
        BlockDriverCompletionFunc *cb, void *opaque);
63
static BlockDriverAIOCB *bdrv_aio_writev_em(BlockDriverState *bs,
64
        int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
65
        BlockDriverCompletionFunc *cb, void *opaque);
66
static void bdrv_aio_cancel_em(BlockDriverAIOCB *acb);
67
static int bdrv_read_em(BlockDriverState *bs, int64_t sector_num,
68
                        uint8_t *buf, int nb_sectors);
69
static int bdrv_write_em(BlockDriverState *bs, int64_t sector_num,
70
                         const uint8_t *buf, int nb_sectors);
71

    
72
BlockDriverState *bdrv_first;
73

    
74
static BlockDriver *first_drv;
75

    
76
int path_is_absolute(const char *path)
77
{
78
    const char *p;
79
#ifdef _WIN32
80
    /* specific case for names like: "\\.\d:" */
81
    if (*path == '/' || *path == '\\')
82
        return 1;
83
#endif
84
    p = strchr(path, ':');
85
    if (p)
86
        p++;
87
    else
88
        p = path;
89
#ifdef _WIN32
90
    return (*p == '/' || *p == '\\');
91
#else
92
    return (*p == '/');
93
#endif
94
}
95

    
96
/* if filename is absolute, just copy it to dest. Otherwise, build a
97
   path to it by considering it is relative to base_path. URL are
98
   supported. */
99
void path_combine(char *dest, int dest_size,
100
                  const char *base_path,
101
                  const char *filename)
102
{
103
    const char *p, *p1;
104
    int len;
105

    
106
    if (dest_size <= 0)
107
        return;
108
    if (path_is_absolute(filename)) {
109
        pstrcpy(dest, dest_size, filename);
110
    } else {
111
        p = strchr(base_path, ':');
112
        if (p)
113
            p++;
114
        else
115
            p = base_path;
116
        p1 = strrchr(base_path, '/');
117
#ifdef _WIN32
118
        {
119
            const char *p2;
120
            p2 = strrchr(base_path, '\\');
121
            if (!p1 || p2 > p1)
122
                p1 = p2;
123
        }
124
#endif
125
        if (p1)
126
            p1++;
127
        else
128
            p1 = base_path;
129
        if (p1 > p)
130
            p = p1;
131
        len = p - base_path;
132
        if (len > dest_size - 1)
133
            len = dest_size - 1;
134
        memcpy(dest, base_path, len);
135
        dest[len] = '\0';
136
        pstrcat(dest, dest_size, filename);
137
    }
138
}
139

    
140

    
141
static void bdrv_register(BlockDriver *bdrv)
142
{
143
    if (!bdrv->bdrv_aio_readv) {
144
        /* add AIO emulation layer */
145
        bdrv->bdrv_aio_readv = bdrv_aio_readv_em;
146
        bdrv->bdrv_aio_writev = bdrv_aio_writev_em;
147
        bdrv->bdrv_aio_cancel = bdrv_aio_cancel_em;
148
        bdrv->aiocb_size = sizeof(BlockDriverAIOCBSync);
149
    } else if (!bdrv->bdrv_read) {
150
        /* add synchronous IO emulation layer */
151
        bdrv->bdrv_read = bdrv_read_em;
152
        bdrv->bdrv_write = bdrv_write_em;
153
    }
154
    aio_pool_init(&bdrv->aio_pool, bdrv->aiocb_size, bdrv->bdrv_aio_cancel);
155
    bdrv->next = first_drv;
156
    first_drv = bdrv;
157
}
158

    
159
/* create a new block device (by default it is empty) */
160
BlockDriverState *bdrv_new(const char *device_name)
161
{
162
    BlockDriverState **pbs, *bs;
163

    
164
    bs = qemu_mallocz(sizeof(BlockDriverState));
165
    pstrcpy(bs->device_name, sizeof(bs->device_name), device_name);
166
    if (device_name[0] != '\0') {
167
        /* insert at the end */
168
        pbs = &bdrv_first;
169
        while (*pbs != NULL)
170
            pbs = &(*pbs)->next;
171
        *pbs = bs;
172
    }
173
    return bs;
174
}
175

    
176
BlockDriver *bdrv_find_format(const char *format_name)
177
{
178
    BlockDriver *drv1;
179
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
180
        if (!strcmp(drv1->format_name, format_name))
181
            return drv1;
182
    }
183
    return NULL;
184
}
185

    
186
int bdrv_create2(BlockDriver *drv,
187
                const char *filename, int64_t size_in_sectors,
188
                const char *backing_file, const char *backing_format,
189
                int flags)
190
{
191
    if (drv->bdrv_create2)
192
        return drv->bdrv_create2(filename, size_in_sectors, backing_file,
193
                                 backing_format, flags);
194
    if (drv->bdrv_create)
195
        return drv->bdrv_create(filename, size_in_sectors, backing_file,
196
                                flags);
197
    return -ENOTSUP;
198
}
199

    
200
int bdrv_create(BlockDriver *drv,
201
                const char *filename, int64_t size_in_sectors,
202
                const char *backing_file, int flags)
203
{
204
    if (!drv->bdrv_create)
205
        return -ENOTSUP;
206
    return drv->bdrv_create(filename, size_in_sectors, backing_file, flags);
207
}
208

    
209
#ifdef _WIN32
210
void get_tmp_filename(char *filename, int size)
211
{
212
    char temp_dir[MAX_PATH];
213

    
214
    GetTempPath(MAX_PATH, temp_dir);
215
    GetTempFileName(temp_dir, "qem", 0, filename);
216
}
217
#else
218
void get_tmp_filename(char *filename, int size)
219
{
220
    int fd;
221
    const char *tmpdir;
222
    /* XXX: race condition possible */
223
    tmpdir = getenv("TMPDIR");
224
    if (!tmpdir)
225
        tmpdir = "/tmp";
226
    snprintf(filename, size, "%s/vl.XXXXXX", tmpdir);
227
    fd = mkstemp(filename);
228
    close(fd);
229
}
230
#endif
231

    
232
#ifdef _WIN32
233
static int is_windows_drive_prefix(const char *filename)
234
{
235
    return (((filename[0] >= 'a' && filename[0] <= 'z') ||
236
             (filename[0] >= 'A' && filename[0] <= 'Z')) &&
237
            filename[1] == ':');
238
}
239

    
240
static int is_windows_drive(const char *filename)
241
{
242
    if (is_windows_drive_prefix(filename) &&
243
        filename[2] == '\0')
244
        return 1;
245
    if (strstart(filename, "\\\\.\\", NULL) ||
246
        strstart(filename, "//./", NULL))
247
        return 1;
248
    return 0;
249
}
250
#endif
251

    
252
static BlockDriver *find_protocol(const char *filename)
253
{
254
    BlockDriver *drv1;
255
    char protocol[128];
256
    int len;
257
    const char *p;
258

    
259
#ifdef _WIN32
260
    if (is_windows_drive(filename) ||
261
        is_windows_drive_prefix(filename))
262
        return &bdrv_raw;
263
#endif
264
    p = strchr(filename, ':');
265
    if (!p)
266
        return &bdrv_raw;
267
    len = p - filename;
268
    if (len > sizeof(protocol) - 1)
269
        len = sizeof(protocol) - 1;
270
    memcpy(protocol, filename, len);
271
    protocol[len] = '\0';
272
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
273
        if (drv1->protocol_name &&
274
            !strcmp(drv1->protocol_name, protocol))
275
            return drv1;
276
    }
277
    return NULL;
278
}
279

    
280
/* XXX: force raw format if block or character device ? It would
281
   simplify the BSD case */
282
static BlockDriver *find_image_format(const char *filename)
283
{
284
    int ret, score, score_max;
285
    BlockDriver *drv1, *drv;
286
    uint8_t buf[2048];
287
    BlockDriverState *bs;
288

    
289
    /* detect host devices. By convention, /dev/cdrom[N] is always
290
       recognized as a host CDROM */
291
    if (strstart(filename, "/dev/cdrom", NULL))
292
        return &bdrv_host_device;
293
#ifdef _WIN32
294
    if (is_windows_drive(filename))
295
        return &bdrv_host_device;
296
#else
297
    {
298
        struct stat st;
299
        if (stat(filename, &st) >= 0 &&
300
            (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode))) {
301
            return &bdrv_host_device;
302
        }
303
    }
304
#endif
305

    
306
    drv = find_protocol(filename);
307
    /* no need to test disk image formats for vvfat */
308
    if (drv == &bdrv_vvfat)
309
        return drv;
310

    
311
    ret = bdrv_file_open(&bs, filename, BDRV_O_RDONLY);
312
    if (ret < 0)
313
        return NULL;
314
    ret = bdrv_pread(bs, 0, buf, sizeof(buf));
315
    bdrv_delete(bs);
316
    if (ret < 0) {
317
        return NULL;
318
    }
319

    
320
    score_max = 0;
321
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
322
        if (drv1->bdrv_probe) {
323
            score = drv1->bdrv_probe(buf, ret, filename);
324
            if (score > score_max) {
325
                score_max = score;
326
                drv = drv1;
327
            }
328
        }
329
    }
330
    return drv;
331
}
332

    
333
int bdrv_file_open(BlockDriverState **pbs, const char *filename, int flags)
334
{
335
    BlockDriverState *bs;
336
    int ret;
337

    
338
    bs = bdrv_new("");
339
    ret = bdrv_open2(bs, filename, flags | BDRV_O_FILE, NULL);
340
    if (ret < 0) {
341
        bdrv_delete(bs);
342
        return ret;
343
    }
344
    bs->growable = 1;
345
    *pbs = bs;
346
    return 0;
347
}
348

    
349
int bdrv_open(BlockDriverState *bs, const char *filename, int flags)
350
{
351
    return bdrv_open2(bs, filename, flags, NULL);
352
}
353

    
354
int bdrv_open2(BlockDriverState *bs, const char *filename, int flags,
355
               BlockDriver *drv)
356
{
357
    int ret, open_flags;
358
    char tmp_filename[PATH_MAX];
359
    char backing_filename[PATH_MAX];
360

    
361
    bs->read_only = 0;
362
    bs->is_temporary = 0;
363
    bs->encrypted = 0;
364
    bs->valid_key = 0;
365
    /* buffer_alignment defaulted to 512, drivers can change this value */
366
    bs->buffer_alignment = 512;
367

    
368
    if (flags & BDRV_O_SNAPSHOT) {
369
        BlockDriverState *bs1;
370
        int64_t total_size;
371
        int is_protocol = 0;
372

    
373
        /* if snapshot, we create a temporary backing file and open it
374
           instead of opening 'filename' directly */
375

    
376
        /* if there is a backing file, use it */
377
        bs1 = bdrv_new("");
378
        ret = bdrv_open2(bs1, filename, 0, drv);
379
        if (ret < 0) {
380
            bdrv_delete(bs1);
381
            return ret;
382
        }
383
        total_size = bdrv_getlength(bs1) >> SECTOR_BITS;
384

    
385
        if (bs1->drv && bs1->drv->protocol_name)
386
            is_protocol = 1;
387

    
388
        bdrv_delete(bs1);
389

    
390
        get_tmp_filename(tmp_filename, sizeof(tmp_filename));
391

    
392
        /* Real path is meaningless for protocols */
393
        if (is_protocol)
394
            snprintf(backing_filename, sizeof(backing_filename),
395
                     "%s", filename);
396
        else
397
            realpath(filename, backing_filename);
398

    
399
        ret = bdrv_create2(&bdrv_qcow2, tmp_filename,
400
                           total_size, backing_filename, 
401
                           (drv ? drv->format_name : NULL), 0);
402
        if (ret < 0) {
403
            return ret;
404
        }
405
        filename = tmp_filename;
406
        drv = &bdrv_qcow2;
407
        bs->is_temporary = 1;
408
    }
409

    
410
    pstrcpy(bs->filename, sizeof(bs->filename), filename);
411
    if (flags & BDRV_O_FILE) {
412
        drv = find_protocol(filename);
413
    } else if (!drv) {
414
        drv = find_image_format(filename);
415
    }
416
    if (!drv) {
417
        ret = -ENOENT;
418
        goto unlink_and_fail;
419
    }
420
    bs->drv = drv;
421
    bs->opaque = qemu_mallocz(drv->instance_size);
422
    /* Note: for compatibility, we open disk image files as RDWR, and
423
       RDONLY as fallback */
424
    if (!(flags & BDRV_O_FILE))
425
        open_flags = BDRV_O_RDWR | (flags & BDRV_O_CACHE_MASK);
426
    else
427
        open_flags = flags & ~(BDRV_O_FILE | BDRV_O_SNAPSHOT);
428
    ret = drv->bdrv_open(bs, filename, open_flags);
429
    if ((ret == -EACCES || ret == -EPERM) && !(flags & BDRV_O_FILE)) {
430
        ret = drv->bdrv_open(bs, filename, open_flags & ~BDRV_O_RDWR);
431
        bs->read_only = 1;
432
    }
433
    if (ret < 0) {
434
        qemu_free(bs->opaque);
435
        bs->opaque = NULL;
436
        bs->drv = NULL;
437
    unlink_and_fail:
438
        if (bs->is_temporary)
439
            unlink(filename);
440
        return ret;
441
    }
442
    if (drv->bdrv_getlength) {
443
        bs->total_sectors = bdrv_getlength(bs) >> SECTOR_BITS;
444
    }
445
#ifndef _WIN32
446
    if (bs->is_temporary) {
447
        unlink(filename);
448
    }
449
#endif
450
    if (bs->backing_file[0] != '\0') {
451
        /* if there is a backing file, use it */
452
        BlockDriver *back_drv = NULL;
453
        bs->backing_hd = bdrv_new("");
454
        path_combine(backing_filename, sizeof(backing_filename),
455
                     filename, bs->backing_file);
456
        if (bs->backing_format[0] != '\0')
457
            back_drv = bdrv_find_format(bs->backing_format);
458
        ret = bdrv_open2(bs->backing_hd, backing_filename, open_flags,
459
                         back_drv);
460
        if (ret < 0) {
461
            bdrv_close(bs);
462
            return ret;
463
        }
464
    }
465

    
466
    if (!bdrv_key_required(bs)) {
467
        /* call the change callback */
468
        bs->media_changed = 1;
469
        if (bs->change_cb)
470
            bs->change_cb(bs->change_opaque);
471
    }
472
    return 0;
473
}
474

    
475
void bdrv_close(BlockDriverState *bs)
476
{
477
    if (bs->drv) {
478
        if (bs->backing_hd)
479
            bdrv_delete(bs->backing_hd);
480
        bs->drv->bdrv_close(bs);
481
        qemu_free(bs->opaque);
482
#ifdef _WIN32
483
        if (bs->is_temporary) {
484
            unlink(bs->filename);
485
        }
486
#endif
487
        bs->opaque = NULL;
488
        bs->drv = NULL;
489

    
490
        /* call the change callback */
491
        bs->media_changed = 1;
492
        if (bs->change_cb)
493
            bs->change_cb(bs->change_opaque);
494
    }
495
}
496

    
497
void bdrv_delete(BlockDriverState *bs)
498
{
499
    BlockDriverState **pbs;
500

    
501
    pbs = &bdrv_first;
502
    while (*pbs != bs && *pbs != NULL)
503
        pbs = &(*pbs)->next;
504
    if (*pbs == bs)
505
        *pbs = bs->next;
506

    
507
    bdrv_close(bs);
508
    qemu_free(bs);
509
}
510

    
511
/*
512
 * Run consistency checks on an image
513
 *
514
 * Returns the number of errors or -errno when an internal error occurs
515
 */
516
int bdrv_check(BlockDriverState *bs)
517
{
518
    if (bs->drv->bdrv_check == NULL) {
519
        return -ENOTSUP;
520
    }
521

    
522
    return bs->drv->bdrv_check(bs);
523
}
524

    
525
/* commit COW file into the raw image */
526
int bdrv_commit(BlockDriverState *bs)
527
{
528
    BlockDriver *drv = bs->drv;
529
    int64_t i, total_sectors;
530
    int n, j;
531
    unsigned char sector[512];
532

    
533
    if (!drv)
534
        return -ENOMEDIUM;
535

    
536
    if (bs->read_only) {
537
        return -EACCES;
538
    }
539

    
540
    if (!bs->backing_hd) {
541
        return -ENOTSUP;
542
    }
543

    
544
    total_sectors = bdrv_getlength(bs) >> SECTOR_BITS;
545
    for (i = 0; i < total_sectors;) {
546
        if (drv->bdrv_is_allocated(bs, i, 65536, &n)) {
547
            for(j = 0; j < n; j++) {
548
                if (bdrv_read(bs, i, sector, 1) != 0) {
549
                    return -EIO;
550
                }
551

    
552
                if (bdrv_write(bs->backing_hd, i, sector, 1) != 0) {
553
                    return -EIO;
554
                }
555
                i++;
556
            }
557
        } else {
558
            i += n;
559
        }
560
    }
561

    
562
    if (drv->bdrv_make_empty)
563
        return drv->bdrv_make_empty(bs);
564

    
565
    return 0;
566
}
567

    
568
static int bdrv_check_byte_request(BlockDriverState *bs, int64_t offset,
569
                                   size_t size)
570
{
571
    int64_t len;
572

    
573
    if (!bdrv_is_inserted(bs))
574
        return -ENOMEDIUM;
575

    
576
    if (bs->growable)
577
        return 0;
578

    
579
    len = bdrv_getlength(bs);
580

    
581
    if (offset < 0)
582
        return -EIO;
583

    
584
    if ((offset > len) || (len - offset < size))
585
        return -EIO;
586

    
587
    return 0;
588
}
589

    
590
static int bdrv_check_request(BlockDriverState *bs, int64_t sector_num,
591
                              int nb_sectors)
592
{
593
    return bdrv_check_byte_request(bs, sector_num * 512, nb_sectors * 512);
594
}
595

    
596
/* return < 0 if error. See bdrv_write() for the return codes */
597
int bdrv_read(BlockDriverState *bs, int64_t sector_num,
598
              uint8_t *buf, int nb_sectors)
599
{
600
    BlockDriver *drv = bs->drv;
601

    
602
    if (!drv)
603
        return -ENOMEDIUM;
604
    if (bdrv_check_request(bs, sector_num, nb_sectors))
605
        return -EIO;
606

    
607
    return drv->bdrv_read(bs, sector_num, buf, nb_sectors);
608
}
609

    
610
/* Return < 0 if error. Important errors are:
611
  -EIO         generic I/O error (may happen for all errors)
612
  -ENOMEDIUM   No media inserted.
613
  -EINVAL      Invalid sector number or nb_sectors
614
  -EACCES      Trying to write a read-only device
615
*/
616
int bdrv_write(BlockDriverState *bs, int64_t sector_num,
617
               const uint8_t *buf, int nb_sectors)
618
{
619
    BlockDriver *drv = bs->drv;
620
    if (!bs->drv)
621
        return -ENOMEDIUM;
622
    if (bs->read_only)
623
        return -EACCES;
624
    if (bdrv_check_request(bs, sector_num, nb_sectors))
625
        return -EIO;
626

    
627
    return drv->bdrv_write(bs, sector_num, buf, nb_sectors);
628
}
629

    
630
int bdrv_pread(BlockDriverState *bs, int64_t offset,
631
               void *buf, int count1)
632
{
633
    uint8_t tmp_buf[SECTOR_SIZE];
634
    int len, nb_sectors, count;
635
    int64_t sector_num;
636

    
637
    count = count1;
638
    /* first read to align to sector start */
639
    len = (SECTOR_SIZE - offset) & (SECTOR_SIZE - 1);
640
    if (len > count)
641
        len = count;
642
    sector_num = offset >> SECTOR_BITS;
643
    if (len > 0) {
644
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
645
            return -EIO;
646
        memcpy(buf, tmp_buf + (offset & (SECTOR_SIZE - 1)), len);
647
        count -= len;
648
        if (count == 0)
649
            return count1;
650
        sector_num++;
651
        buf += len;
652
    }
653

    
654
    /* read the sectors "in place" */
655
    nb_sectors = count >> SECTOR_BITS;
656
    if (nb_sectors > 0) {
657
        if (bdrv_read(bs, sector_num, buf, nb_sectors) < 0)
658
            return -EIO;
659
        sector_num += nb_sectors;
660
        len = nb_sectors << SECTOR_BITS;
661
        buf += len;
662
        count -= len;
663
    }
664

    
665
    /* add data from the last sector */
666
    if (count > 0) {
667
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
668
            return -EIO;
669
        memcpy(buf, tmp_buf, count);
670
    }
671
    return count1;
672
}
673

    
674
int bdrv_pwrite(BlockDriverState *bs, int64_t offset,
675
                const void *buf, int count1)
676
{
677
    uint8_t tmp_buf[SECTOR_SIZE];
678
    int len, nb_sectors, count;
679
    int64_t sector_num;
680

    
681
    count = count1;
682
    /* first write to align to sector start */
683
    len = (SECTOR_SIZE - offset) & (SECTOR_SIZE - 1);
684
    if (len > count)
685
        len = count;
686
    sector_num = offset >> SECTOR_BITS;
687
    if (len > 0) {
688
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
689
            return -EIO;
690
        memcpy(tmp_buf + (offset & (SECTOR_SIZE - 1)), buf, len);
691
        if (bdrv_write(bs, sector_num, tmp_buf, 1) < 0)
692
            return -EIO;
693
        count -= len;
694
        if (count == 0)
695
            return count1;
696
        sector_num++;
697
        buf += len;
698
    }
699

    
700
    /* write the sectors "in place" */
701
    nb_sectors = count >> SECTOR_BITS;
702
    if (nb_sectors > 0) {
703
        if (bdrv_write(bs, sector_num, buf, nb_sectors) < 0)
704
            return -EIO;
705
        sector_num += nb_sectors;
706
        len = nb_sectors << SECTOR_BITS;
707
        buf += len;
708
        count -= len;
709
    }
710

    
711
    /* add data from the last sector */
712
    if (count > 0) {
713
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
714
            return -EIO;
715
        memcpy(tmp_buf, buf, count);
716
        if (bdrv_write(bs, sector_num, tmp_buf, 1) < 0)
717
            return -EIO;
718
    }
719
    return count1;
720
}
721

    
722
/**
723
 * Truncate file to 'offset' bytes (needed only for file protocols)
724
 */
725
int bdrv_truncate(BlockDriverState *bs, int64_t offset)
726
{
727
    BlockDriver *drv = bs->drv;
728
    if (!drv)
729
        return -ENOMEDIUM;
730
    if (!drv->bdrv_truncate)
731
        return -ENOTSUP;
732
    return drv->bdrv_truncate(bs, offset);
733
}
734

    
735
/**
736
 * Length of a file in bytes. Return < 0 if error or unknown.
737
 */
738
int64_t bdrv_getlength(BlockDriverState *bs)
739
{
740
    BlockDriver *drv = bs->drv;
741
    if (!drv)
742
        return -ENOMEDIUM;
743
    if (!drv->bdrv_getlength) {
744
        /* legacy mode */
745
        return bs->total_sectors * SECTOR_SIZE;
746
    }
747
    return drv->bdrv_getlength(bs);
748
}
749

    
750
/* return 0 as number of sectors if no device present or error */
751
void bdrv_get_geometry(BlockDriverState *bs, uint64_t *nb_sectors_ptr)
752
{
753
    int64_t length;
754
    length = bdrv_getlength(bs);
755
    if (length < 0)
756
        length = 0;
757
    else
758
        length = length >> SECTOR_BITS;
759
    *nb_sectors_ptr = length;
760
}
761

    
762
struct partition {
763
        uint8_t boot_ind;           /* 0x80 - active */
764
        uint8_t head;               /* starting head */
765
        uint8_t sector;             /* starting sector */
766
        uint8_t cyl;                /* starting cylinder */
767
        uint8_t sys_ind;            /* What partition type */
768
        uint8_t end_head;           /* end head */
769
        uint8_t end_sector;         /* end sector */
770
        uint8_t end_cyl;            /* end cylinder */
771
        uint32_t start_sect;        /* starting sector counting from 0 */
772
        uint32_t nr_sects;          /* nr of sectors in partition */
773
} __attribute__((packed));
774

    
775
/* try to guess the disk logical geometry from the MSDOS partition table. Return 0 if OK, -1 if could not guess */
776
static int guess_disk_lchs(BlockDriverState *bs,
777
                           int *pcylinders, int *pheads, int *psectors)
778
{
779
    uint8_t buf[512];
780
    int ret, i, heads, sectors, cylinders;
781
    struct partition *p;
782
    uint32_t nr_sects;
783
    uint64_t nb_sectors;
784

    
785
    bdrv_get_geometry(bs, &nb_sectors);
786

    
787
    ret = bdrv_read(bs, 0, buf, 1);
788
    if (ret < 0)
789
        return -1;
790
    /* test msdos magic */
791
    if (buf[510] != 0x55 || buf[511] != 0xaa)
792
        return -1;
793
    for(i = 0; i < 4; i++) {
794
        p = ((struct partition *)(buf + 0x1be)) + i;
795
        nr_sects = le32_to_cpu(p->nr_sects);
796
        if (nr_sects && p->end_head) {
797
            /* We make the assumption that the partition terminates on
798
               a cylinder boundary */
799
            heads = p->end_head + 1;
800
            sectors = p->end_sector & 63;
801
            if (sectors == 0)
802
                continue;
803
            cylinders = nb_sectors / (heads * sectors);
804
            if (cylinders < 1 || cylinders > 16383)
805
                continue;
806
            *pheads = heads;
807
            *psectors = sectors;
808
            *pcylinders = cylinders;
809
#if 0
810
            printf("guessed geometry: LCHS=%d %d %d\n",
811
                   cylinders, heads, sectors);
812
#endif
813
            return 0;
814
        }
815
    }
816
    return -1;
817
}
818

    
819
void bdrv_guess_geometry(BlockDriverState *bs, int *pcyls, int *pheads, int *psecs)
820
{
821
    int translation, lba_detected = 0;
822
    int cylinders, heads, secs;
823
    uint64_t nb_sectors;
824

    
825
    /* if a geometry hint is available, use it */
826
    bdrv_get_geometry(bs, &nb_sectors);
827
    bdrv_get_geometry_hint(bs, &cylinders, &heads, &secs);
828
    translation = bdrv_get_translation_hint(bs);
829
    if (cylinders != 0) {
830
        *pcyls = cylinders;
831
        *pheads = heads;
832
        *psecs = secs;
833
    } else {
834
        if (guess_disk_lchs(bs, &cylinders, &heads, &secs) == 0) {
835
            if (heads > 16) {
836
                /* if heads > 16, it means that a BIOS LBA
837
                   translation was active, so the default
838
                   hardware geometry is OK */
839
                lba_detected = 1;
840
                goto default_geometry;
841
            } else {
842
                *pcyls = cylinders;
843
                *pheads = heads;
844
                *psecs = secs;
845
                /* disable any translation to be in sync with
846
                   the logical geometry */
847
                if (translation == BIOS_ATA_TRANSLATION_AUTO) {
848
                    bdrv_set_translation_hint(bs,
849
                                              BIOS_ATA_TRANSLATION_NONE);
850
                }
851
            }
852
        } else {
853
        default_geometry:
854
            /* if no geometry, use a standard physical disk geometry */
855
            cylinders = nb_sectors / (16 * 63);
856

    
857
            if (cylinders > 16383)
858
                cylinders = 16383;
859
            else if (cylinders < 2)
860
                cylinders = 2;
861
            *pcyls = cylinders;
862
            *pheads = 16;
863
            *psecs = 63;
864
            if ((lba_detected == 1) && (translation == BIOS_ATA_TRANSLATION_AUTO)) {
865
                if ((*pcyls * *pheads) <= 131072) {
866
                    bdrv_set_translation_hint(bs,
867
                                              BIOS_ATA_TRANSLATION_LARGE);
868
                } else {
869
                    bdrv_set_translation_hint(bs,
870
                                              BIOS_ATA_TRANSLATION_LBA);
871
                }
872
            }
873
        }
874
        bdrv_set_geometry_hint(bs, *pcyls, *pheads, *psecs);
875
    }
876
}
877

    
878
void bdrv_set_geometry_hint(BlockDriverState *bs,
879
                            int cyls, int heads, int secs)
880
{
881
    bs->cyls = cyls;
882
    bs->heads = heads;
883
    bs->secs = secs;
884
}
885

    
886
void bdrv_set_type_hint(BlockDriverState *bs, int type)
887
{
888
    bs->type = type;
889
    bs->removable = ((type == BDRV_TYPE_CDROM ||
890
                      type == BDRV_TYPE_FLOPPY));
891
}
892

    
893
void bdrv_set_translation_hint(BlockDriverState *bs, int translation)
894
{
895
    bs->translation = translation;
896
}
897

    
898
void bdrv_get_geometry_hint(BlockDriverState *bs,
899
                            int *pcyls, int *pheads, int *psecs)
900
{
901
    *pcyls = bs->cyls;
902
    *pheads = bs->heads;
903
    *psecs = bs->secs;
904
}
905

    
906
int bdrv_get_type_hint(BlockDriverState *bs)
907
{
908
    return bs->type;
909
}
910

    
911
int bdrv_get_translation_hint(BlockDriverState *bs)
912
{
913
    return bs->translation;
914
}
915

    
916
int bdrv_is_removable(BlockDriverState *bs)
917
{
918
    return bs->removable;
919
}
920

    
921
int bdrv_is_read_only(BlockDriverState *bs)
922
{
923
    return bs->read_only;
924
}
925

    
926
int bdrv_is_sg(BlockDriverState *bs)
927
{
928
    return bs->sg;
929
}
930

    
931
/* XXX: no longer used */
932
void bdrv_set_change_cb(BlockDriverState *bs,
933
                        void (*change_cb)(void *opaque), void *opaque)
934
{
935
    bs->change_cb = change_cb;
936
    bs->change_opaque = opaque;
937
}
938

    
939
int bdrv_is_encrypted(BlockDriverState *bs)
940
{
941
    if (bs->backing_hd && bs->backing_hd->encrypted)
942
        return 1;
943
    return bs->encrypted;
944
}
945

    
946
int bdrv_key_required(BlockDriverState *bs)
947
{
948
    BlockDriverState *backing_hd = bs->backing_hd;
949

    
950
    if (backing_hd && backing_hd->encrypted && !backing_hd->valid_key)
951
        return 1;
952
    return (bs->encrypted && !bs->valid_key);
953
}
954

    
955
int bdrv_set_key(BlockDriverState *bs, const char *key)
956
{
957
    int ret;
958
    if (bs->backing_hd && bs->backing_hd->encrypted) {
959
        ret = bdrv_set_key(bs->backing_hd, key);
960
        if (ret < 0)
961
            return ret;
962
        if (!bs->encrypted)
963
            return 0;
964
    }
965
    if (!bs->encrypted || !bs->drv || !bs->drv->bdrv_set_key)
966
        return -1;
967
    ret = bs->drv->bdrv_set_key(bs, key);
968
    if (ret < 0) {
969
        bs->valid_key = 0;
970
    } else if (!bs->valid_key) {
971
        bs->valid_key = 1;
972
        /* call the change callback now, we skipped it on open */
973
        bs->media_changed = 1;
974
        if (bs->change_cb)
975
            bs->change_cb(bs->change_opaque);
976
    }
977
    return ret;
978
}
979

    
980
void bdrv_get_format(BlockDriverState *bs, char *buf, int buf_size)
981
{
982
    if (!bs->drv) {
983
        buf[0] = '\0';
984
    } else {
985
        pstrcpy(buf, buf_size, bs->drv->format_name);
986
    }
987
}
988

    
989
void bdrv_iterate_format(void (*it)(void *opaque, const char *name),
990
                         void *opaque)
991
{
992
    BlockDriver *drv;
993

    
994
    for (drv = first_drv; drv != NULL; drv = drv->next) {
995
        it(opaque, drv->format_name);
996
    }
997
}
998

    
999
BlockDriverState *bdrv_find(const char *name)
1000
{
1001
    BlockDriverState *bs;
1002

    
1003
    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
1004
        if (!strcmp(name, bs->device_name))
1005
            return bs;
1006
    }
1007
    return NULL;
1008
}
1009

    
1010
void bdrv_iterate(void (*it)(void *opaque, BlockDriverState *bs), void *opaque)
1011
{
1012
    BlockDriverState *bs;
1013

    
1014
    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
1015
        it(opaque, bs);
1016
    }
1017
}
1018

    
1019
const char *bdrv_get_device_name(BlockDriverState *bs)
1020
{
1021
    return bs->device_name;
1022
}
1023

    
1024
void bdrv_flush(BlockDriverState *bs)
1025
{
1026
    if (!bs->drv)
1027
        return;
1028
    if (bs->drv->bdrv_flush)
1029
        bs->drv->bdrv_flush(bs);
1030
    if (bs->backing_hd)
1031
        bdrv_flush(bs->backing_hd);
1032
}
1033

    
1034
void bdrv_flush_all(void)
1035
{
1036
    BlockDriverState *bs;
1037

    
1038
    for (bs = bdrv_first; bs != NULL; bs = bs->next)
1039
        if (bs->drv && !bdrv_is_read_only(bs) && 
1040
            (!bdrv_is_removable(bs) || bdrv_is_inserted(bs)))
1041
            bdrv_flush(bs);
1042
}
1043

    
1044
/*
1045
 * Returns true iff the specified sector is present in the disk image. Drivers
1046
 * not implementing the functionality are assumed to not support backing files,
1047
 * hence all their sectors are reported as allocated.
1048
 *
1049
 * 'pnum' is set to the number of sectors (including and immediately following
1050
 * the specified sector) that are known to be in the same
1051
 * allocated/unallocated state.
1052
 *
1053
 * 'nb_sectors' is the max value 'pnum' should be set to.
1054
 */
1055
int bdrv_is_allocated(BlockDriverState *bs, int64_t sector_num, int nb_sectors,
1056
        int *pnum)
1057
{
1058
    int64_t n;
1059
    if (!bs->drv->bdrv_is_allocated) {
1060
        if (sector_num >= bs->total_sectors) {
1061
            *pnum = 0;
1062
            return 0;
1063
        }
1064
        n = bs->total_sectors - sector_num;
1065
        *pnum = (n < nb_sectors) ? (n) : (nb_sectors);
1066
        return 1;
1067
    }
1068
    return bs->drv->bdrv_is_allocated(bs, sector_num, nb_sectors, pnum);
1069
}
1070

    
1071
void bdrv_info(Monitor *mon)
1072
{
1073
    BlockDriverState *bs;
1074

    
1075
    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
1076
        monitor_printf(mon, "%s:", bs->device_name);
1077
        monitor_printf(mon, " type=");
1078
        switch(bs->type) {
1079
        case BDRV_TYPE_HD:
1080
            monitor_printf(mon, "hd");
1081
            break;
1082
        case BDRV_TYPE_CDROM:
1083
            monitor_printf(mon, "cdrom");
1084
            break;
1085
        case BDRV_TYPE_FLOPPY:
1086
            monitor_printf(mon, "floppy");
1087
            break;
1088
        }
1089
        monitor_printf(mon, " removable=%d", bs->removable);
1090
        if (bs->removable) {
1091
            monitor_printf(mon, " locked=%d", bs->locked);
1092
        }
1093
        if (bs->drv) {
1094
            monitor_printf(mon, " file=");
1095
            monitor_print_filename(mon, bs->filename);
1096
            if (bs->backing_file[0] != '\0') {
1097
                monitor_printf(mon, " backing_file=");
1098
                monitor_print_filename(mon, bs->backing_file);
1099
            }
1100
            monitor_printf(mon, " ro=%d", bs->read_only);
1101
            monitor_printf(mon, " drv=%s", bs->drv->format_name);
1102
            monitor_printf(mon, " encrypted=%d", bdrv_is_encrypted(bs));
1103
        } else {
1104
            monitor_printf(mon, " [not inserted]");
1105
        }
1106
        monitor_printf(mon, "\n");
1107
    }
1108
}
1109

    
1110
/* The "info blockstats" command. */
1111
void bdrv_info_stats(Monitor *mon)
1112
{
1113
    BlockDriverState *bs;
1114

    
1115
    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
1116
        monitor_printf(mon, "%s:"
1117
                       " rd_bytes=%" PRIu64
1118
                       " wr_bytes=%" PRIu64
1119
                       " rd_operations=%" PRIu64
1120
                       " wr_operations=%" PRIu64
1121
                       "\n",
1122
                       bs->device_name,
1123
                       bs->rd_bytes, bs->wr_bytes,
1124
                       bs->rd_ops, bs->wr_ops);
1125
    }
1126
}
1127

    
1128
const char *bdrv_get_encrypted_filename(BlockDriverState *bs)
1129
{
1130
    if (bs->backing_hd && bs->backing_hd->encrypted)
1131
        return bs->backing_file;
1132
    else if (bs->encrypted)
1133
        return bs->filename;
1134
    else
1135
        return NULL;
1136
}
1137

    
1138
void bdrv_get_backing_filename(BlockDriverState *bs,
1139
                               char *filename, int filename_size)
1140
{
1141
    if (!bs->backing_hd) {
1142
        pstrcpy(filename, filename_size, "");
1143
    } else {
1144
        pstrcpy(filename, filename_size, bs->backing_file);
1145
    }
1146
}
1147

    
1148
int bdrv_write_compressed(BlockDriverState *bs, int64_t sector_num,
1149
                          const uint8_t *buf, int nb_sectors)
1150
{
1151
    BlockDriver *drv = bs->drv;
1152
    if (!drv)
1153
        return -ENOMEDIUM;
1154
    if (!drv->bdrv_write_compressed)
1155
        return -ENOTSUP;
1156
    if (bdrv_check_request(bs, sector_num, nb_sectors))
1157
        return -EIO;
1158
    return drv->bdrv_write_compressed(bs, sector_num, buf, nb_sectors);
1159
}
1160

    
1161
int bdrv_get_info(BlockDriverState *bs, BlockDriverInfo *bdi)
1162
{
1163
    BlockDriver *drv = bs->drv;
1164
    if (!drv)
1165
        return -ENOMEDIUM;
1166
    if (!drv->bdrv_get_info)
1167
        return -ENOTSUP;
1168
    memset(bdi, 0, sizeof(*bdi));
1169
    return drv->bdrv_get_info(bs, bdi);
1170
}
1171

    
1172
int bdrv_put_buffer(BlockDriverState *bs, const uint8_t *buf, int64_t pos, int size)
1173
{
1174
    BlockDriver *drv = bs->drv;
1175
    if (!drv)
1176
        return -ENOMEDIUM;
1177
    if (!drv->bdrv_put_buffer)
1178
        return -ENOTSUP;
1179
    return drv->bdrv_put_buffer(bs, buf, pos, size);
1180
}
1181

    
1182
int bdrv_get_buffer(BlockDriverState *bs, uint8_t *buf, int64_t pos, int size)
1183
{
1184
    BlockDriver *drv = bs->drv;
1185
    if (!drv)
1186
        return -ENOMEDIUM;
1187
    if (!drv->bdrv_get_buffer)
1188
        return -ENOTSUP;
1189
    return drv->bdrv_get_buffer(bs, buf, pos, size);
1190
}
1191

    
1192
/**************************************************************/
1193
/* handling of snapshots */
1194

    
1195
int bdrv_snapshot_create(BlockDriverState *bs,
1196
                         QEMUSnapshotInfo *sn_info)
1197
{
1198
    BlockDriver *drv = bs->drv;
1199
    if (!drv)
1200
        return -ENOMEDIUM;
1201
    if (!drv->bdrv_snapshot_create)
1202
        return -ENOTSUP;
1203
    return drv->bdrv_snapshot_create(bs, sn_info);
1204
}
1205

    
1206
int bdrv_snapshot_goto(BlockDriverState *bs,
1207
                       const char *snapshot_id)
1208
{
1209
    BlockDriver *drv = bs->drv;
1210
    if (!drv)
1211
        return -ENOMEDIUM;
1212
    if (!drv->bdrv_snapshot_goto)
1213
        return -ENOTSUP;
1214
    return drv->bdrv_snapshot_goto(bs, snapshot_id);
1215
}
1216

    
1217
int bdrv_snapshot_delete(BlockDriverState *bs, const char *snapshot_id)
1218
{
1219
    BlockDriver *drv = bs->drv;
1220
    if (!drv)
1221
        return -ENOMEDIUM;
1222
    if (!drv->bdrv_snapshot_delete)
1223
        return -ENOTSUP;
1224
    return drv->bdrv_snapshot_delete(bs, snapshot_id);
1225
}
1226

    
1227
int bdrv_snapshot_list(BlockDriverState *bs,
1228
                       QEMUSnapshotInfo **psn_info)
1229
{
1230
    BlockDriver *drv = bs->drv;
1231
    if (!drv)
1232
        return -ENOMEDIUM;
1233
    if (!drv->bdrv_snapshot_list)
1234
        return -ENOTSUP;
1235
    return drv->bdrv_snapshot_list(bs, psn_info);
1236
}
1237

    
1238
#define NB_SUFFIXES 4
1239

    
1240
char *get_human_readable_size(char *buf, int buf_size, int64_t size)
1241
{
1242
    static const char suffixes[NB_SUFFIXES] = "KMGT";
1243
    int64_t base;
1244
    int i;
1245

    
1246
    if (size <= 999) {
1247
        snprintf(buf, buf_size, "%" PRId64, size);
1248
    } else {
1249
        base = 1024;
1250
        for(i = 0; i < NB_SUFFIXES; i++) {
1251
            if (size < (10 * base)) {
1252
                snprintf(buf, buf_size, "%0.1f%c",
1253
                         (double)size / base,
1254
                         suffixes[i]);
1255
                break;
1256
            } else if (size < (1000 * base) || i == (NB_SUFFIXES - 1)) {
1257
                snprintf(buf, buf_size, "%" PRId64 "%c",
1258
                         ((size + (base >> 1)) / base),
1259
                         suffixes[i]);
1260
                break;
1261
            }
1262
            base = base * 1024;
1263
        }
1264
    }
1265
    return buf;
1266
}
1267

    
1268
char *bdrv_snapshot_dump(char *buf, int buf_size, QEMUSnapshotInfo *sn)
1269
{
1270
    char buf1[128], date_buf[128], clock_buf[128];
1271
#ifdef _WIN32
1272
    struct tm *ptm;
1273
#else
1274
    struct tm tm;
1275
#endif
1276
    time_t ti;
1277
    int64_t secs;
1278

    
1279
    if (!sn) {
1280
        snprintf(buf, buf_size,
1281
                 "%-10s%-20s%7s%20s%15s",
1282
                 "ID", "TAG", "VM SIZE", "DATE", "VM CLOCK");
1283
    } else {
1284
        ti = sn->date_sec;
1285
#ifdef _WIN32
1286
        ptm = localtime(&ti);
1287
        strftime(date_buf, sizeof(date_buf),
1288
                 "%Y-%m-%d %H:%M:%S", ptm);
1289
#else
1290
        localtime_r(&ti, &tm);
1291
        strftime(date_buf, sizeof(date_buf),
1292
                 "%Y-%m-%d %H:%M:%S", &tm);
1293
#endif
1294
        secs = sn->vm_clock_nsec / 1000000000;
1295
        snprintf(clock_buf, sizeof(clock_buf),
1296
                 "%02d:%02d:%02d.%03d",
1297
                 (int)(secs / 3600),
1298
                 (int)((secs / 60) % 60),
1299
                 (int)(secs % 60),
1300
                 (int)((sn->vm_clock_nsec / 1000000) % 1000));
1301
        snprintf(buf, buf_size,
1302
                 "%-10s%-20s%7s%20s%15s",
1303
                 sn->id_str, sn->name,
1304
                 get_human_readable_size(buf1, sizeof(buf1), sn->vm_state_size),
1305
                 date_buf,
1306
                 clock_buf);
1307
    }
1308
    return buf;
1309
}
1310

    
1311

    
1312
/**************************************************************/
1313
/* async I/Os */
1314

    
1315
BlockDriverAIOCB *bdrv_aio_readv(BlockDriverState *bs, int64_t sector_num,
1316
                                 QEMUIOVector *qiov, int nb_sectors,
1317
                                 BlockDriverCompletionFunc *cb, void *opaque)
1318
{
1319
    BlockDriver *drv = bs->drv;
1320
    BlockDriverAIOCB *ret;
1321

    
1322
    if (!drv)
1323
        return NULL;
1324
    if (bdrv_check_request(bs, sector_num, nb_sectors))
1325
        return NULL;
1326

    
1327
    ret = drv->bdrv_aio_readv(bs, sector_num, qiov, nb_sectors,
1328
                              cb, opaque);
1329

    
1330
    if (ret) {
1331
        /* Update stats even though technically transfer has not happened. */
1332
        bs->rd_bytes += (unsigned) nb_sectors * SECTOR_SIZE;
1333
        bs->rd_ops ++;
1334
    }
1335

    
1336
    return ret;
1337
}
1338

    
1339
BlockDriverAIOCB *bdrv_aio_writev(BlockDriverState *bs, int64_t sector_num,
1340
                                  QEMUIOVector *qiov, int nb_sectors,
1341
                                  BlockDriverCompletionFunc *cb, void *opaque)
1342
{
1343
    BlockDriver *drv = bs->drv;
1344
    BlockDriverAIOCB *ret;
1345

    
1346
    if (!drv)
1347
        return NULL;
1348
    if (bs->read_only)
1349
        return NULL;
1350
    if (bdrv_check_request(bs, sector_num, nb_sectors))
1351
        return NULL;
1352

    
1353
    ret = drv->bdrv_aio_writev(bs, sector_num, qiov, nb_sectors,
1354
                               cb, opaque);
1355

    
1356
    if (ret) {
1357
        /* Update stats even though technically transfer has not happened. */
1358
        bs->wr_bytes += (unsigned) nb_sectors * SECTOR_SIZE;
1359
        bs->wr_ops ++;
1360
    }
1361

    
1362
    return ret;
1363
}
1364

    
1365
void bdrv_aio_cancel(BlockDriverAIOCB *acb)
1366
{
1367
    acb->pool->cancel(acb);
1368
}
1369

    
1370

    
1371
/**************************************************************/
1372
/* async block device emulation */
1373

    
1374
static void bdrv_aio_bh_cb(void *opaque)
1375
{
1376
    BlockDriverAIOCBSync *acb = opaque;
1377

    
1378
    if (!acb->is_write)
1379
        qemu_iovec_from_buffer(acb->qiov, acb->bounce, acb->qiov->size);
1380
    qemu_vfree(acb->bounce);
1381
    acb->common.cb(acb->common.opaque, acb->ret);
1382

    
1383
    qemu_aio_release(acb);
1384
}
1385

    
1386
static BlockDriverAIOCB *bdrv_aio_rw_vector(BlockDriverState *bs,
1387
                                            int64_t sector_num,
1388
                                            QEMUIOVector *qiov,
1389
                                            int nb_sectors,
1390
                                            BlockDriverCompletionFunc *cb,
1391
                                            void *opaque,
1392
                                            int is_write)
1393

    
1394
{
1395
    BlockDriverAIOCBSync *acb;
1396

    
1397
    acb = qemu_aio_get(bs, cb, opaque);
1398
    acb->is_write = is_write;
1399
    acb->qiov = qiov;
1400
    acb->bounce = qemu_blockalign(bs, qiov->size);
1401

    
1402
    if (!acb->bh)
1403
        acb->bh = qemu_bh_new(bdrv_aio_bh_cb, acb);
1404

    
1405
    if (is_write) {
1406
        qemu_iovec_to_buffer(acb->qiov, acb->bounce);
1407
        acb->ret = bdrv_write(bs, sector_num, acb->bounce, nb_sectors);
1408
    } else {
1409
        acb->ret = bdrv_read(bs, sector_num, acb->bounce, nb_sectors);
1410
    }
1411

    
1412
    qemu_bh_schedule(acb->bh);
1413

    
1414
    return &acb->common;
1415
}
1416

    
1417
static BlockDriverAIOCB *bdrv_aio_readv_em(BlockDriverState *bs,
1418
        int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
1419
        BlockDriverCompletionFunc *cb, void *opaque)
1420
{
1421
    return bdrv_aio_rw_vector(bs, sector_num, qiov, nb_sectors, cb, opaque, 0);
1422
}
1423

    
1424
static BlockDriverAIOCB *bdrv_aio_writev_em(BlockDriverState *bs,
1425
        int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
1426
        BlockDriverCompletionFunc *cb, void *opaque)
1427
{
1428
    return bdrv_aio_rw_vector(bs, sector_num, qiov, nb_sectors, cb, opaque, 1);
1429
}
1430

    
1431

    
1432
static void bdrv_aio_cancel_em(BlockDriverAIOCB *blockacb)
1433
{
1434
    BlockDriverAIOCBSync *acb = (BlockDriverAIOCBSync *)blockacb;
1435
    qemu_bh_cancel(acb->bh);
1436
    qemu_aio_release(acb);
1437
}
1438

    
1439
/**************************************************************/
1440
/* sync block device emulation */
1441

    
1442
static void bdrv_rw_em_cb(void *opaque, int ret)
1443
{
1444
    *(int *)opaque = ret;
1445
}
1446

    
1447
#define NOT_DONE 0x7fffffff
1448

    
1449
static int bdrv_read_em(BlockDriverState *bs, int64_t sector_num,
1450
                        uint8_t *buf, int nb_sectors)
1451
{
1452
    int async_ret;
1453
    BlockDriverAIOCB *acb;
1454
    struct iovec iov;
1455
    QEMUIOVector qiov;
1456

    
1457
    async_ret = NOT_DONE;
1458
    iov.iov_base = (void *)buf;
1459
    iov.iov_len = nb_sectors * 512;
1460
    qemu_iovec_init_external(&qiov, &iov, 1);
1461
    acb = bdrv_aio_readv(bs, sector_num, &qiov, nb_sectors,
1462
        bdrv_rw_em_cb, &async_ret);
1463
    if (acb == NULL)
1464
        return -1;
1465

    
1466
    while (async_ret == NOT_DONE) {
1467
        qemu_aio_wait();
1468
    }
1469

    
1470
    return async_ret;
1471
}
1472

    
1473
static int bdrv_write_em(BlockDriverState *bs, int64_t sector_num,
1474
                         const uint8_t *buf, int nb_sectors)
1475
{
1476
    int async_ret;
1477
    BlockDriverAIOCB *acb;
1478
    struct iovec iov;
1479
    QEMUIOVector qiov;
1480

    
1481
    async_ret = NOT_DONE;
1482
    iov.iov_base = (void *)buf;
1483
    iov.iov_len = nb_sectors * 512;
1484
    qemu_iovec_init_external(&qiov, &iov, 1);
1485
    acb = bdrv_aio_writev(bs, sector_num, &qiov, nb_sectors,
1486
        bdrv_rw_em_cb, &async_ret);
1487
    if (acb == NULL)
1488
        return -1;
1489
    while (async_ret == NOT_DONE) {
1490
        qemu_aio_wait();
1491
    }
1492
    return async_ret;
1493
}
1494

    
1495
void bdrv_init(void)
1496
{
1497
    bdrv_register(&bdrv_raw);
1498
    bdrv_register(&bdrv_host_device);
1499
#ifndef _WIN32
1500
    bdrv_register(&bdrv_cow);
1501
#endif
1502
    bdrv_register(&bdrv_qcow);
1503
    bdrv_register(&bdrv_vmdk);
1504
    bdrv_register(&bdrv_cloop);
1505
    bdrv_register(&bdrv_dmg);
1506
    bdrv_register(&bdrv_bochs);
1507
    bdrv_register(&bdrv_vpc);
1508
    bdrv_register(&bdrv_vvfat);
1509
    bdrv_register(&bdrv_qcow2);
1510
    bdrv_register(&bdrv_parallels);
1511
    bdrv_register(&bdrv_nbd);
1512
}
1513

    
1514
void aio_pool_init(AIOPool *pool, int aiocb_size,
1515
                   void (*cancel)(BlockDriverAIOCB *acb))
1516
{
1517
    pool->aiocb_size = aiocb_size;
1518
    pool->cancel = cancel;
1519
    pool->free_aiocb = NULL;
1520
}
1521

    
1522
void *qemu_aio_get_pool(AIOPool *pool, BlockDriverState *bs,
1523
                        BlockDriverCompletionFunc *cb, void *opaque)
1524
{
1525
    BlockDriverAIOCB *acb;
1526

    
1527
    if (pool->free_aiocb) {
1528
        acb = pool->free_aiocb;
1529
        pool->free_aiocb = acb->next;
1530
    } else {
1531
        acb = qemu_mallocz(pool->aiocb_size);
1532
        acb->pool = pool;
1533
    }
1534
    acb->bs = bs;
1535
    acb->cb = cb;
1536
    acb->opaque = opaque;
1537
    return acb;
1538
}
1539

    
1540
void *qemu_aio_get(BlockDriverState *bs, BlockDriverCompletionFunc *cb,
1541
                   void *opaque)
1542
{
1543
    return qemu_aio_get_pool(&bs->drv->aio_pool, bs, cb, opaque);
1544
}
1545

    
1546
void qemu_aio_release(void *p)
1547
{
1548
    BlockDriverAIOCB *acb = (BlockDriverAIOCB *)p;
1549
    AIOPool *pool = acb->pool;
1550
    acb->next = pool->free_aiocb;
1551
    pool->free_aiocb = acb;
1552
}
1553

    
1554
/**************************************************************/
1555
/* removable device support */
1556

    
1557
/**
1558
 * Return TRUE if the media is present
1559
 */
1560
int bdrv_is_inserted(BlockDriverState *bs)
1561
{
1562
    BlockDriver *drv = bs->drv;
1563
    int ret;
1564
    if (!drv)
1565
        return 0;
1566
    if (!drv->bdrv_is_inserted)
1567
        return 1;
1568
    ret = drv->bdrv_is_inserted(bs);
1569
    return ret;
1570
}
1571

    
1572
/**
1573
 * Return TRUE if the media changed since the last call to this
1574
 * function. It is currently only used for floppy disks
1575
 */
1576
int bdrv_media_changed(BlockDriverState *bs)
1577
{
1578
    BlockDriver *drv = bs->drv;
1579
    int ret;
1580

    
1581
    if (!drv || !drv->bdrv_media_changed)
1582
        ret = -ENOTSUP;
1583
    else
1584
        ret = drv->bdrv_media_changed(bs);
1585
    if (ret == -ENOTSUP)
1586
        ret = bs->media_changed;
1587
    bs->media_changed = 0;
1588
    return ret;
1589
}
1590

    
1591
/**
1592
 * If eject_flag is TRUE, eject the media. Otherwise, close the tray
1593
 */
1594
void bdrv_eject(BlockDriverState *bs, int eject_flag)
1595
{
1596
    BlockDriver *drv = bs->drv;
1597
    int ret;
1598

    
1599
    if (!drv || !drv->bdrv_eject) {
1600
        ret = -ENOTSUP;
1601
    } else {
1602
        ret = drv->bdrv_eject(bs, eject_flag);
1603
    }
1604
    if (ret == -ENOTSUP) {
1605
        if (eject_flag)
1606
            bdrv_close(bs);
1607
    }
1608
}
1609

    
1610
int bdrv_is_locked(BlockDriverState *bs)
1611
{
1612
    return bs->locked;
1613
}
1614

    
1615
/**
1616
 * Lock or unlock the media (if it is locked, the user won't be able
1617
 * to eject it manually).
1618
 */
1619
void bdrv_set_locked(BlockDriverState *bs, int locked)
1620
{
1621
    BlockDriver *drv = bs->drv;
1622

    
1623
    bs->locked = locked;
1624
    if (drv && drv->bdrv_set_locked) {
1625
        drv->bdrv_set_locked(bs, locked);
1626
    }
1627
}
1628

    
1629
/* needed for generic scsi interface */
1630

    
1631
int bdrv_ioctl(BlockDriverState *bs, unsigned long int req, void *buf)
1632
{
1633
    BlockDriver *drv = bs->drv;
1634

    
1635
    if (drv && drv->bdrv_ioctl)
1636
        return drv->bdrv_ioctl(bs, req, buf);
1637
    return -ENOTSUP;
1638
}
1639

    
1640
BlockDriverAIOCB *bdrv_aio_ioctl(BlockDriverState *bs,
1641
        unsigned long int req, void *buf,
1642
        BlockDriverCompletionFunc *cb, void *opaque)
1643
{
1644
    BlockDriver *drv = bs->drv;
1645

    
1646
    if (drv && drv->bdrv_aio_ioctl)
1647
        return drv->bdrv_aio_ioctl(bs, req, buf, cb, opaque);
1648
    return NULL;
1649
}
1650

    
1651
void *qemu_blockalign(BlockDriverState *bs, size_t size)
1652
{
1653
    return qemu_memalign((bs && bs->buffer_alignment) ? bs->buffer_alignment : 512, size);
1654
}