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

P
pbrook 已提交
30
#include "qemu-common.h"
A
aliguori 已提交
31
#include "monitor.h"
B
bellard 已提交
32
#include "block_int.h"
B
bellard 已提交
33

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

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

B
bellard 已提交
47 48 49
#define SECTOR_BITS 9
#define SECTOR_SIZE (1 << SECTOR_BITS)

B
bellard 已提交
50 51 52 53 54 55
typedef struct BlockDriverAIOCBSync {
    BlockDriverAIOCB common;
    QEMUBH *bh;
    int ret;
} BlockDriverAIOCBSync;

56 57 58 59 60 61
static BlockDriverAIOCB *bdrv_aio_read_em(BlockDriverState *bs,
        int64_t sector_num, uint8_t *buf, int nb_sectors,
        BlockDriverCompletionFunc *cb, void *opaque);
static BlockDriverAIOCB *bdrv_aio_write_em(BlockDriverState *bs,
        int64_t sector_num, const uint8_t *buf, int nb_sectors,
        BlockDriverCompletionFunc *cb, void *opaque);
B
bellard 已提交
62
static void bdrv_aio_cancel_em(BlockDriverAIOCB *acb);
63
static int bdrv_read_em(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
64 65 66
                        uint8_t *buf, int nb_sectors);
static int bdrv_write_em(BlockDriverState *bs, int64_t sector_num,
                         const uint8_t *buf, int nb_sectors);
B
bellard 已提交
67

68 69
BlockDriverState *bdrv_first;

B
bellard 已提交
70 71
static BlockDriver *first_drv;

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

B
bellard 已提交
92 93 94 95 96 97
/* if filename is absolute, just copy it to dest. Otherwise, build a
   path to it by considering it is relative to base_path. URL are
   supported. */
void path_combine(char *dest, int dest_size,
                  const char *base_path,
                  const char *filename)
98
{
B
bellard 已提交
99 100 101 102 103 104 105 106 107 108 109 110 111
    const char *p, *p1;
    int len;

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


137
static void bdrv_register(BlockDriver *bdrv)
B
bellard 已提交
138
{
139
    if (!bdrv->bdrv_aio_read) {
B
bellard 已提交
140 141 142 143
        /* add AIO emulation layer */
        bdrv->bdrv_aio_read = bdrv_aio_read_em;
        bdrv->bdrv_aio_write = bdrv_aio_write_em;
        bdrv->bdrv_aio_cancel = bdrv_aio_cancel_em;
B
bellard 已提交
144
        bdrv->aiocb_size = sizeof(BlockDriverAIOCBSync);
B
bellard 已提交
145 146 147 148 149
    } else if (!bdrv->bdrv_read && !bdrv->bdrv_pread) {
        /* add synchronous IO emulation layer */
        bdrv->bdrv_read = bdrv_read_em;
        bdrv->bdrv_write = bdrv_write_em;
    }
B
bellard 已提交
150 151 152
    bdrv->next = first_drv;
    first_drv = bdrv;
}
B
bellard 已提交
153 154 155 156 157 158 159 160

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

    bs = qemu_mallocz(sizeof(BlockDriverState));
    pstrcpy(bs->device_name, sizeof(bs->device_name), device_name);
B
bellard 已提交
161 162 163 164 165 166 167
    if (device_name[0] != '\0') {
        /* insert at the end */
        pbs = &bdrv_first;
        while (*pbs != NULL)
            pbs = &(*pbs)->next;
        *pbs = bs;
    }
B
bellard 已提交
168 169 170
    return bs;
}

B
bellard 已提交
171 172 173 174 175 176 177 178 179 180
BlockDriver *bdrv_find_format(const char *format_name)
{
    BlockDriver *drv1;
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
        if (!strcmp(drv1->format_name, format_name))
            return drv1;
    }
    return NULL;
}

181
int bdrv_create(BlockDriver *drv,
B
bellard 已提交
182 183 184 185 186 187 188 189
                const char *filename, int64_t size_in_sectors,
                const char *backing_file, int flags)
{
    if (!drv->bdrv_create)
        return -ENOTSUP;
    return drv->bdrv_create(filename, size_in_sectors, backing_file, flags);
}

B
bellard 已提交
190
#ifdef _WIN32
191
void get_tmp_filename(char *filename, int size)
B
bellard 已提交
192
{
193
    char temp_dir[MAX_PATH];
194

195 196
    GetTempPath(MAX_PATH, temp_dir);
    GetTempFileName(temp_dir, "qem", 0, filename);
B
bellard 已提交
197 198
}
#else
199
void get_tmp_filename(char *filename, int size)
B
bellard 已提交
200
{
B
bellard 已提交
201
    int fd;
202
    const char *tmpdir;
B
bellard 已提交
203
    /* XXX: race condition possible */
A
aurel32 已提交
204 205 206 207
    tmpdir = getenv("TMPDIR");
    if (!tmpdir)
        tmpdir = "/tmp";
    snprintf(filename, size, "%s/vl.XXXXXX", tmpdir);
B
bellard 已提交
208 209 210
    fd = mkstemp(filename);
    close(fd);
}
B
bellard 已提交
211
#endif
B
bellard 已提交
212

B
bellard 已提交
213
#ifdef _WIN32
B
bellard 已提交
214 215 216 217 218 219
static int is_windows_drive_prefix(const char *filename)
{
    return (((filename[0] >= 'a' && filename[0] <= 'z') ||
             (filename[0] >= 'A' && filename[0] <= 'Z')) &&
            filename[1] == ':');
}
220

B
bellard 已提交
221 222
static int is_windows_drive(const char *filename)
{
223
    if (is_windows_drive_prefix(filename) &&
B
bellard 已提交
224
        filename[2] == '\0')
B
bellard 已提交
225 226 227 228 229 230 231 232
        return 1;
    if (strstart(filename, "\\\\.\\", NULL) ||
        strstart(filename, "//./", NULL))
        return 1;
    return 0;
}
#endif

B
bellard 已提交
233 234 235 236 237 238
static BlockDriver *find_protocol(const char *filename)
{
    BlockDriver *drv1;
    char protocol[128];
    int len;
    const char *p;
B
bellard 已提交
239 240

#ifdef _WIN32
B
bellard 已提交
241 242
    if (is_windows_drive(filename) ||
        is_windows_drive_prefix(filename))
B
bellard 已提交
243 244
        return &bdrv_raw;
#endif
B
bellard 已提交
245 246 247 248 249 250 251 252 253
    p = strchr(filename, ':');
    if (!p)
        return &bdrv_raw;
    len = p - filename;
    if (len > sizeof(protocol) - 1)
        len = sizeof(protocol) - 1;
    memcpy(protocol, filename, len);
    protocol[len] = '\0';
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
254
        if (drv1->protocol_name &&
B
bellard 已提交
255 256 257 258 259 260
            !strcmp(drv1->protocol_name, protocol))
            return drv1;
    }
    return NULL;
}

B
bellard 已提交
261 262
/* XXX: force raw format if block or character device ? It would
   simplify the BSD case */
B
bellard 已提交
263 264
static BlockDriver *find_image_format(const char *filename)
{
B
bellard 已提交
265
    int ret, score, score_max;
B
bellard 已提交
266
    BlockDriver *drv1, *drv;
B
bellard 已提交
267 268
    uint8_t buf[2048];
    BlockDriverState *bs;
269

B
bellard 已提交
270 271 272 273 274 275 276 277 278 279
    /* detect host devices. By convention, /dev/cdrom[N] is always
       recognized as a host CDROM */
    if (strstart(filename, "/dev/cdrom", NULL))
        return &bdrv_host_device;
#ifdef _WIN32
    if (is_windows_drive(filename))
        return &bdrv_host_device;
#else
    {
        struct stat st;
280
        if (stat(filename, &st) >= 0 &&
B
bellard 已提交
281 282 283 284 285
            (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode))) {
            return &bdrv_host_device;
        }
    }
#endif
286

B
bellard 已提交
287
    drv = find_protocol(filename);
B
bellard 已提交
288
    /* no need to test disk image formats for vvfat */
B
bellard 已提交
289 290
    if (drv == &bdrv_vvfat)
        return drv;
B
bellard 已提交
291

B
bellard 已提交
292 293 294 295 296 297 298 299 300
    ret = bdrv_file_open(&bs, filename, BDRV_O_RDONLY);
    if (ret < 0)
        return NULL;
    ret = bdrv_pread(bs, 0, buf, sizeof(buf));
    bdrv_delete(bs);
    if (ret < 0) {
        return NULL;
    }

B
bellard 已提交
301 302
    score_max = 0;
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
B
bellard 已提交
303 304 305 306 307 308
        if (drv1->bdrv_probe) {
            score = drv1->bdrv_probe(buf, ret, filename);
            if (score > score_max) {
                score_max = score;
                drv = drv1;
            }
B
bellard 已提交
309
        }
B
bellard 已提交
310
    }
B
bellard 已提交
311 312 313
    return drv;
}

B
bellard 已提交
314
int bdrv_file_open(BlockDriverState **pbs, const char *filename, int flags)
B
bellard 已提交
315
{
B
bellard 已提交
316 317 318 319 320 321 322 323
    BlockDriverState *bs;
    int ret;

    bs = bdrv_new("");
    ret = bdrv_open2(bs, filename, flags | BDRV_O_FILE, NULL);
    if (ret < 0) {
        bdrv_delete(bs);
        return ret;
324
    }
325
    bs->growable = 1;
B
bellard 已提交
326 327 328 329 330 331 332
    *pbs = bs;
    return 0;
}

int bdrv_open(BlockDriverState *bs, const char *filename, int flags)
{
    return bdrv_open2(bs, filename, flags, NULL);
B
bellard 已提交
333 334
}

B
bellard 已提交
335
int bdrv_open2(BlockDriverState *bs, const char *filename, int flags,
B
bellard 已提交
336 337
               BlockDriver *drv)
{
B
bellard 已提交
338
    int ret, open_flags;
339 340
    char tmp_filename[PATH_MAX];
    char backing_filename[PATH_MAX];
341

B
bellard 已提交
342 343 344
    bs->read_only = 0;
    bs->is_temporary = 0;
    bs->encrypted = 0;
345
    bs->valid_key = 0;
B
bellard 已提交
346

B
bellard 已提交
347
    if (flags & BDRV_O_SNAPSHOT) {
B
bellard 已提交
348 349
        BlockDriverState *bs1;
        int64_t total_size;
A
aliguori 已提交
350
        int is_protocol = 0;
351

B
bellard 已提交
352 353
        /* if snapshot, we create a temporary backing file and open it
           instead of opening 'filename' directly */
354

B
bellard 已提交
355 356
        /* if there is a backing file, use it */
        bs1 = bdrv_new("");
357 358
        ret = bdrv_open(bs1, filename, 0);
        if (ret < 0) {
B
bellard 已提交
359
            bdrv_delete(bs1);
360
            return ret;
B
bellard 已提交
361
        }
B
bellard 已提交
362
        total_size = bdrv_getlength(bs1) >> SECTOR_BITS;
A
aliguori 已提交
363 364 365 366

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

B
bellard 已提交
367
        bdrv_delete(bs1);
368

B
bellard 已提交
369
        get_tmp_filename(tmp_filename, sizeof(tmp_filename));
A
aliguori 已提交
370 371 372 373 374 375 376 377

        /* Real path is meaningless for protocols */
        if (is_protocol)
            snprintf(backing_filename, sizeof(backing_filename),
                     "%s", filename);
        else
            realpath(filename, backing_filename);

378 379 380 381
        ret = bdrv_create(&bdrv_qcow2, tmp_filename,
                          total_size, backing_filename, 0);
        if (ret < 0) {
            return ret;
B
bellard 已提交
382 383 384 385
        }
        filename = tmp_filename;
        bs->is_temporary = 1;
    }
B
bellard 已提交
386

B
bellard 已提交
387
    pstrcpy(bs->filename, sizeof(bs->filename), filename);
B
bellard 已提交
388 389
    if (flags & BDRV_O_FILE) {
        drv = find_protocol(filename);
390 391 392 393 394 395
    } else if (!drv) {
        drv = find_image_format(filename);
    }
    if (!drv) {
        ret = -ENOENT;
        goto unlink_and_fail;
B
bellard 已提交
396 397 398
    }
    bs->drv = drv;
    bs->opaque = qemu_mallocz(drv->instance_size);
B
bellard 已提交
399 400 401
    /* Note: for compatibility, we open disk image files as RDWR, and
       RDONLY as fallback */
    if (!(flags & BDRV_O_FILE))
402
        open_flags = BDRV_O_RDWR | (flags & BDRV_O_CACHE_MASK);
B
bellard 已提交
403 404 405
    else
        open_flags = flags & ~(BDRV_O_FILE | BDRV_O_SNAPSHOT);
    ret = drv->bdrv_open(bs, filename, open_flags);
406
    if ((ret == -EACCES || ret == -EPERM) && !(flags & BDRV_O_FILE)) {
407
        ret = drv->bdrv_open(bs, filename, open_flags & ~BDRV_O_RDWR);
B
bellard 已提交
408 409
        bs->read_only = 1;
    }
B
bellard 已提交
410 411
    if (ret < 0) {
        qemu_free(bs->opaque);
B
bellard 已提交
412 413
        bs->opaque = NULL;
        bs->drv = NULL;
414 415 416
    unlink_and_fail:
        if (bs->is_temporary)
            unlink(filename);
B
bellard 已提交
417
        return ret;
418
    }
419 420 421
    if (drv->bdrv_getlength) {
        bs->total_sectors = bdrv_getlength(bs) >> SECTOR_BITS;
    }
B
bellard 已提交
422
#ifndef _WIN32
B
bellard 已提交
423 424 425 426
    if (bs->is_temporary) {
        unlink(filename);
    }
#endif
B
bellard 已提交
427
    if (bs->backing_file[0] != '\0') {
B
bellard 已提交
428 429
        /* if there is a backing file, use it */
        bs->backing_hd = bdrv_new("");
B
bellard 已提交
430 431
        path_combine(backing_filename, sizeof(backing_filename),
                     filename, bs->backing_file);
432 433 434 435 436
        ret = bdrv_open(bs->backing_hd, backing_filename, open_flags);
        if (ret < 0) {
            bdrv_close(bs);
            return ret;
        }
437 438
    }

439 440 441 442 443 444
    if (!bdrv_key_required(bs)) {
        /* call the change callback */
        bs->media_changed = 1;
        if (bs->change_cb)
            bs->change_cb(bs->change_opaque);
    }
B
bellard 已提交
445
    return 0;
B
bellard 已提交
446 447 448 449
}

void bdrv_close(BlockDriverState *bs)
{
B
bellard 已提交
450
    if (bs->drv) {
B
bellard 已提交
451 452 453 454 455 456 457 458
        if (bs->backing_hd)
            bdrv_delete(bs->backing_hd);
        bs->drv->bdrv_close(bs);
        qemu_free(bs->opaque);
#ifdef _WIN32
        if (bs->is_temporary) {
            unlink(bs->filename);
        }
B
bellard 已提交
459
#endif
B
bellard 已提交
460 461
        bs->opaque = NULL;
        bs->drv = NULL;
B
bellard 已提交
462 463

        /* call the change callback */
B
bellard 已提交
464
        bs->media_changed = 1;
B
bellard 已提交
465 466 467 468 469 470 471
        if (bs->change_cb)
            bs->change_cb(bs->change_opaque);
    }
}

void bdrv_delete(BlockDriverState *bs)
{
472 473 474 475 476 477 478 479
    BlockDriverState **pbs;

    pbs = &bdrv_first;
    while (*pbs != bs && *pbs != NULL)
        pbs = &(*pbs)->next;
    if (*pbs == bs)
        *pbs = bs->next;

B
bellard 已提交
480 481
    bdrv_close(bs);
    qemu_free(bs);
B
bellard 已提交
482 483
}

484 485 486
/* commit COW file into the raw image */
int bdrv_commit(BlockDriverState *bs)
{
B
bellard 已提交
487
    BlockDriver *drv = bs->drv;
B
bellard 已提交
488
    int64_t i, total_sectors;
B
bellard 已提交
489 490
    int n, j;
    unsigned char sector[512];
491

B
bellard 已提交
492 493
    if (!drv)
        return -ENOMEDIUM;
494 495

    if (bs->read_only) {
B
bellard 已提交
496
	return -EACCES;
497 498
    }

B
bellard 已提交
499 500 501
    if (!bs->backing_hd) {
	return -ENOTSUP;
    }
502

B
bellard 已提交
503 504
    total_sectors = bdrv_getlength(bs) >> SECTOR_BITS;
    for (i = 0; i < total_sectors;) {
B
bellard 已提交
505
        if (drv->bdrv_is_allocated(bs, i, 65536, &n)) {
B
bellard 已提交
506 507 508 509 510 511 512 513 514
            for(j = 0; j < n; j++) {
                if (bdrv_read(bs, i, sector, 1) != 0) {
                    return -EIO;
                }

                if (bdrv_write(bs->backing_hd, i, sector, 1) != 0) {
                    return -EIO;
                }
                i++;
515
	    }
B
bellard 已提交
516 517 518
	} else {
            i += n;
        }
519
    }
520

B
bellard 已提交
521 522
    if (drv->bdrv_make_empty)
	return drv->bdrv_make_empty(bs);
523

524 525 526
    return 0;
}

527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
static int bdrv_check_byte_request(BlockDriverState *bs, int64_t offset,
                                   size_t size)
{
    int64_t len;

    if (!bdrv_is_inserted(bs))
        return -ENOMEDIUM;

    if (bs->growable)
        return 0;

    len = bdrv_getlength(bs);

    if ((offset + size) > len)
        return -EIO;

    return 0;
}

static int bdrv_check_request(BlockDriverState *bs, int64_t sector_num,
                              int nb_sectors)
{
    int64_t offset;

    /* Deal with byte accesses */
    if (sector_num < 0)
        offset = -sector_num;
    else
        offset = sector_num * 512;

    return bdrv_check_byte_request(bs, offset, nb_sectors * 512);
}

B
bellard 已提交
560
/* return < 0 if error. See bdrv_write() for the return codes */
561
int bdrv_read(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
562 563
              uint8_t *buf, int nb_sectors)
{
B
bellard 已提交
564 565
    BlockDriver *drv = bs->drv;

B
bellard 已提交
566 567
    if (!drv)
        return -ENOMEDIUM;
568 569
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return -EIO;
B
bellard 已提交
570

B
bellard 已提交
571 572 573 574 575 576 577
    if (drv->bdrv_pread) {
        int ret, len;
        len = nb_sectors * 512;
        ret = drv->bdrv_pread(bs, sector_num * 512, buf, len);
        if (ret < 0)
            return ret;
        else if (ret != len)
B
bellard 已提交
578
            return -EINVAL;
579 580 581
        else {
	    bs->rd_bytes += (unsigned) len;
	    bs->rd_ops ++;
B
bellard 已提交
582
            return 0;
583
	}
B
bellard 已提交
584 585
    } else {
        return drv->bdrv_read(bs, sector_num, buf, nb_sectors);
586
    }
B
bellard 已提交
587 588
}

589
/* Return < 0 if error. Important errors are:
B
bellard 已提交
590 591 592 593 594
  -EIO         generic I/O error (may happen for all errors)
  -ENOMEDIUM   No media inserted.
  -EINVAL      Invalid sector number or nb_sectors
  -EACCES      Trying to write a read-only device
*/
595
int bdrv_write(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
596 597
               const uint8_t *buf, int nb_sectors)
{
B
bellard 已提交
598
    BlockDriver *drv = bs->drv;
B
bellard 已提交
599 600
    if (!bs->drv)
        return -ENOMEDIUM;
B
bellard 已提交
601
    if (bs->read_only)
B
bellard 已提交
602
        return -EACCES;
603 604 605
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return -EIO;

B
bellard 已提交
606
    if (drv->bdrv_pwrite) {
607
        int ret, len, count = 0;
B
bellard 已提交
608
        len = nb_sectors * 512;
609 610 611 612 613 614 615 616 617 618 619 620
        do {
            ret = drv->bdrv_pwrite(bs, sector_num * 512, buf, len - count);
            if (ret < 0) {
                printf("bdrv_write ret=%d\n", ret);
                return ret;
            }
            count += ret;
            buf += ret;
        } while (count != len);
        bs->wr_bytes += (unsigned) len;
        bs->wr_ops ++;
        return 0;
B
bellard 已提交
621
    }
622
    return drv->bdrv_write(bs, sector_num, buf, nb_sectors);
B
bellard 已提交
623 624
}

625
static int bdrv_pread_em(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
626
                         uint8_t *buf, int count1)
B
bellard 已提交
627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668
{
    uint8_t tmp_buf[SECTOR_SIZE];
    int len, nb_sectors, count;
    int64_t sector_num;

    count = count1;
    /* first read to align to sector start */
    len = (SECTOR_SIZE - offset) & (SECTOR_SIZE - 1);
    if (len > count)
        len = count;
    sector_num = offset >> SECTOR_BITS;
    if (len > 0) {
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
            return -EIO;
        memcpy(buf, tmp_buf + (offset & (SECTOR_SIZE - 1)), len);
        count -= len;
        if (count == 0)
            return count1;
        sector_num++;
        buf += len;
    }

    /* read the sectors "in place" */
    nb_sectors = count >> SECTOR_BITS;
    if (nb_sectors > 0) {
        if (bdrv_read(bs, sector_num, buf, nb_sectors) < 0)
            return -EIO;
        sector_num += nb_sectors;
        len = nb_sectors << SECTOR_BITS;
        buf += len;
        count -= len;
    }

    /* add data from the last sector */
    if (count > 0) {
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
            return -EIO;
        memcpy(buf, tmp_buf, count);
    }
    return count1;
}

669
static int bdrv_pwrite_em(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
670
                          const uint8_t *buf, int count1)
B
bellard 已提交
671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717
{
    uint8_t tmp_buf[SECTOR_SIZE];
    int len, nb_sectors, count;
    int64_t sector_num;

    count = count1;
    /* first write to align to sector start */
    len = (SECTOR_SIZE - offset) & (SECTOR_SIZE - 1);
    if (len > count)
        len = count;
    sector_num = offset >> SECTOR_BITS;
    if (len > 0) {
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
            return -EIO;
        memcpy(tmp_buf + (offset & (SECTOR_SIZE - 1)), buf, len);
        if (bdrv_write(bs, sector_num, tmp_buf, 1) < 0)
            return -EIO;
        count -= len;
        if (count == 0)
            return count1;
        sector_num++;
        buf += len;
    }

    /* write the sectors "in place" */
    nb_sectors = count >> SECTOR_BITS;
    if (nb_sectors > 0) {
        if (bdrv_write(bs, sector_num, buf, nb_sectors) < 0)
            return -EIO;
        sector_num += nb_sectors;
        len = nb_sectors << SECTOR_BITS;
        buf += len;
        count -= len;
    }

    /* add data from the last sector */
    if (count > 0) {
        if (bdrv_read(bs, sector_num, tmp_buf, 1) < 0)
            return -EIO;
        memcpy(tmp_buf, buf, count);
        if (bdrv_write(bs, sector_num, tmp_buf, 1) < 0)
            return -EIO;
    }
    return count1;
}

/**
718
 * Read with byte offsets (needed only for file protocols)
B
bellard 已提交
719
 */
720
int bdrv_pread(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
721 722 723 724 725
               void *buf1, int count1)
{
    BlockDriver *drv = bs->drv;

    if (!drv)
B
bellard 已提交
726
        return -ENOMEDIUM;
727 728 729
    if (bdrv_check_byte_request(bs, offset, count1))
        return -EIO;

B
bellard 已提交
730
    if (!drv->bdrv_pread)
B
bellard 已提交
731
        return bdrv_pread_em(bs, offset, buf1, count1);
B
bellard 已提交
732 733 734
    return drv->bdrv_pread(bs, offset, buf1, count1);
}

735 736
/**
 * Write with byte offsets (needed only for file protocols)
B
bellard 已提交
737
 */
738
int bdrv_pwrite(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
739 740 741 742 743
                const void *buf1, int count1)
{
    BlockDriver *drv = bs->drv;

    if (!drv)
B
bellard 已提交
744
        return -ENOMEDIUM;
745 746 747
    if (bdrv_check_byte_request(bs, offset, count1))
        return -EIO;

B
bellard 已提交
748
    if (!drv->bdrv_pwrite)
B
bellard 已提交
749
        return bdrv_pwrite_em(bs, offset, buf1, count1);
B
bellard 已提交
750 751 752 753 754 755 756 757 758 759
    return drv->bdrv_pwrite(bs, offset, buf1, count1);
}

/**
 * Truncate file to 'offset' bytes (needed only for file protocols)
 */
int bdrv_truncate(BlockDriverState *bs, int64_t offset)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
760
        return -ENOMEDIUM;
B
bellard 已提交
761 762 763 764 765 766 767 768 769 770 771 772
    if (!drv->bdrv_truncate)
        return -ENOTSUP;
    return drv->bdrv_truncate(bs, offset);
}

/**
 * Length of a file in bytes. Return < 0 if error or unknown.
 */
int64_t bdrv_getlength(BlockDriverState *bs)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
773
        return -ENOMEDIUM;
B
bellard 已提交
774 775 776 777 778
    if (!drv->bdrv_getlength) {
        /* legacy mode */
        return bs->total_sectors * SECTOR_SIZE;
    }
    return drv->bdrv_getlength(bs);
B
bellard 已提交
779 780
}

B
bellard 已提交
781
/* return 0 as number of sectors if no device present or error */
782
void bdrv_get_geometry(BlockDriverState *bs, uint64_t *nb_sectors_ptr)
B
bellard 已提交
783
{
B
bellard 已提交
784 785 786 787 788 789 790
    int64_t length;
    length = bdrv_getlength(bs);
    if (length < 0)
        length = 0;
    else
        length = length >> SECTOR_BITS;
    *nb_sectors_ptr = length;
B
bellard 已提交
791
}
B
bellard 已提交
792

793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813
struct partition {
        uint8_t boot_ind;           /* 0x80 - active */
        uint8_t head;               /* starting head */
        uint8_t sector;             /* starting sector */
        uint8_t cyl;                /* starting cylinder */
        uint8_t sys_ind;            /* What partition type */
        uint8_t end_head;           /* end head */
        uint8_t end_sector;         /* end sector */
        uint8_t end_cyl;            /* end cylinder */
        uint32_t start_sect;        /* starting sector counting from 0 */
        uint32_t nr_sects;          /* nr of sectors in partition */
} __attribute__((packed));

/* try to guess the disk logical geometry from the MSDOS partition table. Return 0 if OK, -1 if could not guess */
static int guess_disk_lchs(BlockDriverState *bs,
                           int *pcylinders, int *pheads, int *psectors)
{
    uint8_t buf[512];
    int ret, i, heads, sectors, cylinders;
    struct partition *p;
    uint32_t nr_sects;
B
blueswir1 已提交
814
    uint64_t nb_sectors;
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853

    bdrv_get_geometry(bs, &nb_sectors);

    ret = bdrv_read(bs, 0, buf, 1);
    if (ret < 0)
        return -1;
    /* test msdos magic */
    if (buf[510] != 0x55 || buf[511] != 0xaa)
        return -1;
    for(i = 0; i < 4; i++) {
        p = ((struct partition *)(buf + 0x1be)) + i;
        nr_sects = le32_to_cpu(p->nr_sects);
        if (nr_sects && p->end_head) {
            /* We make the assumption that the partition terminates on
               a cylinder boundary */
            heads = p->end_head + 1;
            sectors = p->end_sector & 63;
            if (sectors == 0)
                continue;
            cylinders = nb_sectors / (heads * sectors);
            if (cylinders < 1 || cylinders > 16383)
                continue;
            *pheads = heads;
            *psectors = sectors;
            *pcylinders = cylinders;
#if 0
            printf("guessed geometry: LCHS=%d %d %d\n",
                   cylinders, heads, sectors);
#endif
            return 0;
        }
    }
    return -1;
}

void bdrv_guess_geometry(BlockDriverState *bs, int *pcyls, int *pheads, int *psecs)
{
    int translation, lba_detected = 0;
    int cylinders, heads, secs;
B
blueswir1 已提交
854
    uint64_t nb_sectors;
855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908

    /* if a geometry hint is available, use it */
    bdrv_get_geometry(bs, &nb_sectors);
    bdrv_get_geometry_hint(bs, &cylinders, &heads, &secs);
    translation = bdrv_get_translation_hint(bs);
    if (cylinders != 0) {
        *pcyls = cylinders;
        *pheads = heads;
        *psecs = secs;
    } else {
        if (guess_disk_lchs(bs, &cylinders, &heads, &secs) == 0) {
            if (heads > 16) {
                /* if heads > 16, it means that a BIOS LBA
                   translation was active, so the default
                   hardware geometry is OK */
                lba_detected = 1;
                goto default_geometry;
            } else {
                *pcyls = cylinders;
                *pheads = heads;
                *psecs = secs;
                /* disable any translation to be in sync with
                   the logical geometry */
                if (translation == BIOS_ATA_TRANSLATION_AUTO) {
                    bdrv_set_translation_hint(bs,
                                              BIOS_ATA_TRANSLATION_NONE);
                }
            }
        } else {
        default_geometry:
            /* if no geometry, use a standard physical disk geometry */
            cylinders = nb_sectors / (16 * 63);

            if (cylinders > 16383)
                cylinders = 16383;
            else if (cylinders < 2)
                cylinders = 2;
            *pcyls = cylinders;
            *pheads = 16;
            *psecs = 63;
            if ((lba_detected == 1) && (translation == BIOS_ATA_TRANSLATION_AUTO)) {
                if ((*pcyls * *pheads) <= 131072) {
                    bdrv_set_translation_hint(bs,
                                              BIOS_ATA_TRANSLATION_LARGE);
                } else {
                    bdrv_set_translation_hint(bs,
                                              BIOS_ATA_TRANSLATION_LBA);
                }
            }
        }
        bdrv_set_geometry_hint(bs, *pcyls, *pheads, *psecs);
    }
}

909
void bdrv_set_geometry_hint(BlockDriverState *bs,
B
bellard 已提交
910 911 912 913 914 915 916 917 918 919 920 921 922 923
                            int cyls, int heads, int secs)
{
    bs->cyls = cyls;
    bs->heads = heads;
    bs->secs = secs;
}

void bdrv_set_type_hint(BlockDriverState *bs, int type)
{
    bs->type = type;
    bs->removable = ((type == BDRV_TYPE_CDROM ||
                      type == BDRV_TYPE_FLOPPY));
}

B
bellard 已提交
924 925 926 927 928
void bdrv_set_translation_hint(BlockDriverState *bs, int translation)
{
    bs->translation = translation;
}

929
void bdrv_get_geometry_hint(BlockDriverState *bs,
B
bellard 已提交
930 931 932 933 934 935 936 937 938 939 940 941
                            int *pcyls, int *pheads, int *psecs)
{
    *pcyls = bs->cyls;
    *pheads = bs->heads;
    *psecs = bs->secs;
}

int bdrv_get_type_hint(BlockDriverState *bs)
{
    return bs->type;
}

B
bellard 已提交
942 943 944 945 946
int bdrv_get_translation_hint(BlockDriverState *bs)
{
    return bs->translation;
}

B
bellard 已提交
947 948 949 950 951 952 953 954 955 956
int bdrv_is_removable(BlockDriverState *bs)
{
    return bs->removable;
}

int bdrv_is_read_only(BlockDriverState *bs)
{
    return bs->read_only;
}

957 958 959 960 961
int bdrv_is_sg(BlockDriverState *bs)
{
    return bs->sg;
}

B
bellard 已提交
962
/* XXX: no longer used */
963
void bdrv_set_change_cb(BlockDriverState *bs,
B
bellard 已提交
964 965 966 967 968 969
                        void (*change_cb)(void *opaque), void *opaque)
{
    bs->change_cb = change_cb;
    bs->change_opaque = opaque;
}

B
bellard 已提交
970 971 972 973 974 975 976
int bdrv_is_encrypted(BlockDriverState *bs)
{
    if (bs->backing_hd && bs->backing_hd->encrypted)
        return 1;
    return bs->encrypted;
}

977 978 979 980 981 982 983 984 985
int bdrv_key_required(BlockDriverState *bs)
{
    BlockDriverState *backing_hd = bs->backing_hd;

    if (backing_hd && backing_hd->encrypted && !backing_hd->valid_key)
        return 1;
    return (bs->encrypted && !bs->valid_key);
}

B
bellard 已提交
986 987 988 989 990 991 992 993 994 995 996 997
int bdrv_set_key(BlockDriverState *bs, const char *key)
{
    int ret;
    if (bs->backing_hd && bs->backing_hd->encrypted) {
        ret = bdrv_set_key(bs->backing_hd, key);
        if (ret < 0)
            return ret;
        if (!bs->encrypted)
            return 0;
    }
    if (!bs->encrypted || !bs->drv || !bs->drv->bdrv_set_key)
        return -1;
998
    ret = bs->drv->bdrv_set_key(bs, key);
999 1000 1001 1002 1003 1004 1005 1006 1007
    if (ret < 0) {
        bs->valid_key = 0;
    } else if (!bs->valid_key) {
        bs->valid_key = 1;
        /* call the change callback now, we skipped it on open */
        bs->media_changed = 1;
        if (bs->change_cb)
            bs->change_cb(bs->change_opaque);
    }
1008
    return ret;
B
bellard 已提交
1009 1010 1011 1012
}

void bdrv_get_format(BlockDriverState *bs, char *buf, int buf_size)
{
B
bellard 已提交
1013
    if (!bs->drv) {
B
bellard 已提交
1014 1015 1016 1017 1018 1019
        buf[0] = '\0';
    } else {
        pstrcpy(buf, buf_size, bs->drv->format_name);
    }
}

1020
void bdrv_iterate_format(void (*it)(void *opaque, const char *name),
B
bellard 已提交
1021 1022 1023 1024 1025 1026 1027 1028 1029
                         void *opaque)
{
    BlockDriver *drv;

    for (drv = first_drv; drv != NULL; drv = drv->next) {
        it(opaque, drv->format_name);
    }
}

B
bellard 已提交
1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040
BlockDriverState *bdrv_find(const char *name)
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
        if (!strcmp(name, bs->device_name))
            return bs;
    }
    return NULL;
}

1041
void bdrv_iterate(void (*it)(void *opaque, BlockDriverState *bs), void *opaque)
B
bellard 已提交
1042 1043 1044 1045
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
1046
        it(opaque, bs);
B
bellard 已提交
1047 1048 1049
    }
}

B
bellard 已提交
1050 1051 1052 1053 1054
const char *bdrv_get_device_name(BlockDriverState *bs)
{
    return bs->device_name;
}

P
pbrook 已提交
1055 1056 1057 1058 1059 1060 1061 1062
void bdrv_flush(BlockDriverState *bs)
{
    if (bs->drv->bdrv_flush)
        bs->drv->bdrv_flush(bs);
    if (bs->backing_hd)
        bdrv_flush(bs->backing_hd);
}

A
aliguori 已提交
1063 1064 1065 1066 1067 1068 1069 1070 1071 1072
void bdrv_flush_all(void)
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next)
        if (bs->drv && !bdrv_is_read_only(bs) && 
            (!bdrv_is_removable(bs) || bdrv_is_inserted(bs)))
            bdrv_flush(bs);
}

1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099
/*
 * Returns true iff the specified sector is present in the disk image. Drivers
 * not implementing the functionality are assumed to not support backing files,
 * hence all their sectors are reported as allocated.
 *
 * 'pnum' is set to the number of sectors (including and immediately following
 * the specified sector) that are known to be in the same
 * allocated/unallocated state.
 *
 * 'nb_sectors' is the max value 'pnum' should be set to.
 */
int bdrv_is_allocated(BlockDriverState *bs, int64_t sector_num, int nb_sectors,
	int *pnum)
{
    int64_t n;
    if (!bs->drv->bdrv_is_allocated) {
        if (sector_num >= bs->total_sectors) {
            *pnum = 0;
            return 0;
        }
        n = bs->total_sectors - sector_num;
        *pnum = (n < nb_sectors) ? (n) : (nb_sectors);
        return 1;
    }
    return bs->drv->bdrv_is_allocated(bs, sector_num, nb_sectors, pnum);
}

A
aliguori 已提交
1100
void bdrv_info(Monitor *mon)
B
bellard 已提交
1101 1102 1103 1104
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
A
aliguori 已提交
1105 1106
        monitor_printf(mon, "%s:", bs->device_name);
        monitor_printf(mon, " type=");
B
bellard 已提交
1107 1108
        switch(bs->type) {
        case BDRV_TYPE_HD:
A
aliguori 已提交
1109
            monitor_printf(mon, "hd");
B
bellard 已提交
1110 1111
            break;
        case BDRV_TYPE_CDROM:
A
aliguori 已提交
1112
            monitor_printf(mon, "cdrom");
B
bellard 已提交
1113 1114
            break;
        case BDRV_TYPE_FLOPPY:
A
aliguori 已提交
1115
            monitor_printf(mon, "floppy");
B
bellard 已提交
1116 1117
            break;
        }
A
aliguori 已提交
1118
        monitor_printf(mon, " removable=%d", bs->removable);
B
bellard 已提交
1119
        if (bs->removable) {
A
aliguori 已提交
1120
            monitor_printf(mon, " locked=%d", bs->locked);
B
bellard 已提交
1121
        }
B
bellard 已提交
1122
        if (bs->drv) {
A
aliguori 已提交
1123 1124
            monitor_printf(mon, " file=");
            monitor_print_filename(mon, bs->filename);
1125
            if (bs->backing_file[0] != '\0') {
A
aliguori 已提交
1126 1127 1128 1129 1130 1131
                monitor_printf(mon, " backing_file=");
                monitor_print_filename(mon, bs->backing_file);
            }
            monitor_printf(mon, " ro=%d", bs->read_only);
            monitor_printf(mon, " drv=%s", bs->drv->format_name);
            monitor_printf(mon, " encrypted=%d", bdrv_is_encrypted(bs));
B
bellard 已提交
1132
        } else {
A
aliguori 已提交
1133
            monitor_printf(mon, " [not inserted]");
B
bellard 已提交
1134
        }
A
aliguori 已提交
1135
        monitor_printf(mon, "\n");
B
bellard 已提交
1136 1137
    }
}
1138 1139

/* The "info blockstats" command. */
A
aliguori 已提交
1140
void bdrv_info_stats(Monitor *mon)
1141 1142 1143 1144
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
A
aliguori 已提交
1145 1146 1147 1148 1149
        monitor_printf(mon, "%s:"
                       " rd_bytes=%" PRIu64
                       " wr_bytes=%" PRIu64
                       " rd_operations=%" PRIu64
                       " wr_operations=%" PRIu64
A
aliguori 已提交
1150
                       "\n",
A
aliguori 已提交
1151 1152 1153
                       bs->device_name,
                       bs->rd_bytes, bs->wr_bytes,
                       bs->rd_ops, bs->wr_ops);
1154 1155
    }
}
B
bellard 已提交
1156

1157 1158 1159 1160 1161 1162 1163 1164 1165 1166
const char *bdrv_get_encrypted_filename(BlockDriverState *bs)
{
    if (bs->backing_hd && bs->backing_hd->encrypted)
        return bs->backing_file;
    else if (bs->encrypted)
        return bs->filename;
    else
        return NULL;
}

1167
void bdrv_get_backing_filename(BlockDriverState *bs,
B
bellard 已提交
1168 1169 1170 1171 1172 1173 1174 1175 1176
                               char *filename, int filename_size)
{
    if (!bs->backing_hd) {
        pstrcpy(filename, filename_size, "");
    } else {
        pstrcpy(filename, filename_size, bs->backing_file);
    }
}

1177
int bdrv_write_compressed(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
1178 1179 1180 1181
                          const uint8_t *buf, int nb_sectors)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
1182
        return -ENOMEDIUM;
B
bellard 已提交
1183 1184 1185 1186
    if (!drv->bdrv_write_compressed)
        return -ENOTSUP;
    return drv->bdrv_write_compressed(bs, sector_num, buf, nb_sectors);
}
1187

B
bellard 已提交
1188 1189 1190 1191
int bdrv_get_info(BlockDriverState *bs, BlockDriverInfo *bdi)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
1192
        return -ENOMEDIUM;
B
bellard 已提交
1193 1194 1195 1196 1197 1198 1199 1200 1201
    if (!drv->bdrv_get_info)
        return -ENOTSUP;
    memset(bdi, 0, sizeof(*bdi));
    return drv->bdrv_get_info(bs, bdi);
}

/**************************************************************/
/* handling of snapshots */

1202
int bdrv_snapshot_create(BlockDriverState *bs,
B
bellard 已提交
1203 1204 1205 1206
                         QEMUSnapshotInfo *sn_info)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
1207
        return -ENOMEDIUM;
B
bellard 已提交
1208 1209 1210 1211 1212
    if (!drv->bdrv_snapshot_create)
        return -ENOTSUP;
    return drv->bdrv_snapshot_create(bs, sn_info);
}

1213
int bdrv_snapshot_goto(BlockDriverState *bs,
B
bellard 已提交
1214 1215 1216 1217
                       const char *snapshot_id)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
1218
        return -ENOMEDIUM;
B
bellard 已提交
1219 1220 1221 1222 1223 1224 1225 1226 1227
    if (!drv->bdrv_snapshot_goto)
        return -ENOTSUP;
    return drv->bdrv_snapshot_goto(bs, snapshot_id);
}

int bdrv_snapshot_delete(BlockDriverState *bs, const char *snapshot_id)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
1228
        return -ENOMEDIUM;
B
bellard 已提交
1229 1230 1231 1232 1233
    if (!drv->bdrv_snapshot_delete)
        return -ENOTSUP;
    return drv->bdrv_snapshot_delete(bs, snapshot_id);
}

1234
int bdrv_snapshot_list(BlockDriverState *bs,
B
bellard 已提交
1235 1236 1237 1238
                       QEMUSnapshotInfo **psn_info)
{
    BlockDriver *drv = bs->drv;
    if (!drv)
B
bellard 已提交
1239
        return -ENOMEDIUM;
B
bellard 已提交
1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258
    if (!drv->bdrv_snapshot_list)
        return -ENOTSUP;
    return drv->bdrv_snapshot_list(bs, psn_info);
}

#define NB_SUFFIXES 4

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

    if (size <= 999) {
        snprintf(buf, buf_size, "%" PRId64, size);
    } else {
        base = 1024;
        for(i = 0; i < NB_SUFFIXES; i++) {
            if (size < (10 * base)) {
1259
                snprintf(buf, buf_size, "%0.1f%c",
B
bellard 已提交
1260 1261 1262 1263
                         (double)size / base,
                         suffixes[i]);
                break;
            } else if (size < (1000 * base) || i == (NB_SUFFIXES - 1)) {
1264
                snprintf(buf, buf_size, "%" PRId64 "%c",
B
bellard 已提交
1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
                         ((size + (base >> 1)) / base),
                         suffixes[i]);
                break;
            }
            base = base * 1024;
        }
    }
    return buf;
}

char *bdrv_snapshot_dump(char *buf, int buf_size, QEMUSnapshotInfo *sn)
{
    char buf1[128], date_buf[128], clock_buf[128];
1278 1279 1280
#ifdef _WIN32
    struct tm *ptm;
#else
B
bellard 已提交
1281
    struct tm tm;
1282
#endif
B
bellard 已提交
1283 1284 1285 1286
    time_t ti;
    int64_t secs;

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

B
bellard 已提交
1318

B
bellard 已提交
1319
/**************************************************************/
B
bellard 已提交
1320
/* async I/Os */
B
bellard 已提交
1321

1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334
typedef struct VectorTranslationState {
    QEMUIOVector *iov;
    uint8_t *bounce;
    int is_write;
    BlockDriverAIOCB *aiocb;
    BlockDriverAIOCB *this_aiocb;
} VectorTranslationState;

static void bdrv_aio_rw_vector_cb(void *opaque, int ret)
{
    VectorTranslationState *s = opaque;

    if (!s->is_write) {
1335
        qemu_iovec_from_buffer(s->iov, s->bounce, s->iov->size);
1336
    }
A
aurel32 已提交
1337
    qemu_vfree(s->bounce);
1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372
    s->this_aiocb->cb(s->this_aiocb->opaque, ret);
    qemu_aio_release(s->this_aiocb);
}

static BlockDriverAIOCB *bdrv_aio_rw_vector(BlockDriverState *bs,
                                            int64_t sector_num,
                                            QEMUIOVector *iov,
                                            int nb_sectors,
                                            BlockDriverCompletionFunc *cb,
                                            void *opaque,
                                            int is_write)

{
    VectorTranslationState *s = qemu_mallocz(sizeof(*s));
    BlockDriverAIOCB *aiocb = qemu_aio_get(bs, cb, opaque);

    s->this_aiocb = aiocb;
    s->iov = iov;
    s->bounce = qemu_memalign(512, nb_sectors * 512);
    s->is_write = is_write;
    if (is_write) {
        qemu_iovec_to_buffer(s->iov, s->bounce);
        s->aiocb = bdrv_aio_write(bs, sector_num, s->bounce, nb_sectors,
                                  bdrv_aio_rw_vector_cb, s);
    } else {
        s->aiocb = bdrv_aio_read(bs, sector_num, s->bounce, nb_sectors,
                                 bdrv_aio_rw_vector_cb, s);
    }
    return aiocb;
}

BlockDriverAIOCB *bdrv_aio_readv(BlockDriverState *bs, int64_t sector_num,
                                 QEMUIOVector *iov, int nb_sectors,
                                 BlockDriverCompletionFunc *cb, void *opaque)
{
1373 1374 1375
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return NULL;

1376 1377 1378 1379 1380 1381 1382 1383
    return bdrv_aio_rw_vector(bs, sector_num, iov, nb_sectors,
                              cb, opaque, 0);
}

BlockDriverAIOCB *bdrv_aio_writev(BlockDriverState *bs, int64_t sector_num,
                                  QEMUIOVector *iov, int nb_sectors,
                                  BlockDriverCompletionFunc *cb, void *opaque)
{
1384 1385 1386
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return NULL;

1387 1388 1389 1390
    return bdrv_aio_rw_vector(bs, sector_num, iov, nb_sectors,
                              cb, opaque, 1);
}

1391 1392 1393
BlockDriverAIOCB *bdrv_aio_read(BlockDriverState *bs, int64_t sector_num,
                                uint8_t *buf, int nb_sectors,
                                BlockDriverCompletionFunc *cb, void *opaque)
B
bellard 已提交
1394 1395
{
    BlockDriver *drv = bs->drv;
1396
    BlockDriverAIOCB *ret;
B
bellard 已提交
1397

B
bellard 已提交
1398
    if (!drv)
1399
        return NULL;
1400 1401
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return NULL;
1402

1403 1404 1405 1406 1407 1408 1409 1410 1411
    ret = drv->bdrv_aio_read(bs, sector_num, buf, nb_sectors, cb, opaque);

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

    return ret;
B
bellard 已提交
1412 1413
}

1414 1415 1416
BlockDriverAIOCB *bdrv_aio_write(BlockDriverState *bs, int64_t sector_num,
                                 const uint8_t *buf, int nb_sectors,
                                 BlockDriverCompletionFunc *cb, void *opaque)
B
bellard 已提交
1417
{
B
bellard 已提交
1418
    BlockDriver *drv = bs->drv;
1419
    BlockDriverAIOCB *ret;
B
bellard 已提交
1420

B
bellard 已提交
1421
    if (!drv)
1422
        return NULL;
B
bellard 已提交
1423
    if (bs->read_only)
1424
        return NULL;
1425 1426
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return NULL;
B
bellard 已提交
1427

1428 1429 1430 1431 1432 1433 1434 1435 1436
    ret = drv->bdrv_aio_write(bs, sector_num, buf, nb_sectors, cb, opaque);

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

    return ret;
B
bellard 已提交
1437 1438 1439 1440
}

void bdrv_aio_cancel(BlockDriverAIOCB *acb)
{
1441
    BlockDriver *drv = acb->bs->drv;
B
bellard 已提交
1442

1443 1444 1445 1446 1447
    if (acb->cb == bdrv_aio_rw_vector_cb) {
        VectorTranslationState *s = acb->opaque;
        acb = s->aiocb;
    }

1448
    drv->bdrv_aio_cancel(acb);
B
bellard 已提交
1449 1450
}

1451

B
bellard 已提交
1452 1453 1454
/**************************************************************/
/* async block device emulation */

1455
static void bdrv_aio_bh_cb(void *opaque)
B
bellard 已提交
1456
{
1457 1458 1459
    BlockDriverAIOCBSync *acb = opaque;
    acb->common.cb(acb->common.opaque, acb->ret);
    qemu_aio_release(acb);
B
bellard 已提交
1460
}
1461

1462 1463 1464
static BlockDriverAIOCB *bdrv_aio_read_em(BlockDriverState *bs,
        int64_t sector_num, uint8_t *buf, int nb_sectors,
        BlockDriverCompletionFunc *cb, void *opaque)
B
bellard 已提交
1465
{
1466
    BlockDriverAIOCBSync *acb;
B
bellard 已提交
1467
    int ret;
1468 1469 1470 1471 1472 1473 1474 1475

    acb = qemu_aio_get(bs, cb, opaque);
    if (!acb->bh)
        acb->bh = qemu_bh_new(bdrv_aio_bh_cb, acb);
    ret = bdrv_read(bs, sector_num, buf, nb_sectors);
    acb->ret = ret;
    qemu_bh_schedule(acb->bh);
    return &acb->common;
1476 1477
}

1478 1479 1480
static BlockDriverAIOCB *bdrv_aio_write_em(BlockDriverState *bs,
        int64_t sector_num, const uint8_t *buf, int nb_sectors,
        BlockDriverCompletionFunc *cb, void *opaque)
1481
{
1482
    BlockDriverAIOCBSync *acb;
B
bellard 已提交
1483 1484
    int ret;

1485 1486 1487 1488 1489 1490 1491
    acb = qemu_aio_get(bs, cb, opaque);
    if (!acb->bh)
        acb->bh = qemu_bh_new(bdrv_aio_bh_cb, acb);
    ret = bdrv_write(bs, sector_num, buf, nb_sectors);
    acb->ret = ret;
    qemu_bh_schedule(acb->bh);
    return &acb->common;
1492 1493
}

1494
static void bdrv_aio_cancel_em(BlockDriverAIOCB *blockacb)
B
bellard 已提交
1495
{
1496 1497 1498
    BlockDriverAIOCBSync *acb = (BlockDriverAIOCBSync *)blockacb;
    qemu_bh_cancel(acb->bh);
    qemu_aio_release(acb);
B
bellard 已提交
1499
}
B
bellard 已提交
1500

B
bellard 已提交
1501 1502
/**************************************************************/
/* sync block device emulation */
B
bellard 已提交
1503

B
bellard 已提交
1504 1505 1506
static void bdrv_rw_em_cb(void *opaque, int ret)
{
    *(int *)opaque = ret;
B
bellard 已提交
1507 1508
}

B
bellard 已提交
1509 1510
#define NOT_DONE 0x7fffffff

1511
static int bdrv_read_em(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
1512
                        uint8_t *buf, int nb_sectors)
P
pbrook 已提交
1513
{
1514 1515
    int async_ret;
    BlockDriverAIOCB *acb;
B
bellard 已提交
1516 1517

    async_ret = NOT_DONE;
1518
    acb = bdrv_aio_read(bs, sector_num, buf, nb_sectors,
B
bellard 已提交
1519
                        bdrv_rw_em_cb, &async_ret);
1520
    if (acb == NULL)
1521
        return -1;
1522

B
bellard 已提交
1523 1524 1525
    while (async_ret == NOT_DONE) {
        qemu_aio_wait();
    }
1526

B
bellard 已提交
1527
    return async_ret;
P
pbrook 已提交
1528 1529
}

B
bellard 已提交
1530 1531 1532
static int bdrv_write_em(BlockDriverState *bs, int64_t sector_num,
                         const uint8_t *buf, int nb_sectors)
{
1533 1534
    int async_ret;
    BlockDriverAIOCB *acb;
B
bellard 已提交
1535 1536

    async_ret = NOT_DONE;
1537
    acb = bdrv_aio_write(bs, sector_num, buf, nb_sectors,
B
bellard 已提交
1538
                         bdrv_rw_em_cb, &async_ret);
1539
    if (acb == NULL)
1540
        return -1;
B
bellard 已提交
1541 1542 1543 1544 1545
    while (async_ret == NOT_DONE) {
        qemu_aio_wait();
    }
    return async_ret;
}
B
bellard 已提交
1546 1547 1548 1549

void bdrv_init(void)
{
    bdrv_register(&bdrv_raw);
B
bellard 已提交
1550
    bdrv_register(&bdrv_host_device);
B
bellard 已提交
1551 1552 1553 1554 1555
#ifndef _WIN32
    bdrv_register(&bdrv_cow);
#endif
    bdrv_register(&bdrv_qcow);
    bdrv_register(&bdrv_vmdk);
B
bellard 已提交
1556
    bdrv_register(&bdrv_cloop);
1557
    bdrv_register(&bdrv_dmg);
1558
    bdrv_register(&bdrv_bochs);
1559
    bdrv_register(&bdrv_vpc);
B
bellard 已提交
1560
    bdrv_register(&bdrv_vvfat);
B
bellard 已提交
1561
    bdrv_register(&bdrv_qcow2);
1562
    bdrv_register(&bdrv_parallels);
1563
    bdrv_register(&bdrv_nbd);
B
bellard 已提交
1564
}
1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591

void *qemu_aio_get(BlockDriverState *bs, BlockDriverCompletionFunc *cb,
                   void *opaque)
{
    BlockDriver *drv;
    BlockDriverAIOCB *acb;

    drv = bs->drv;
    if (drv->free_aiocb) {
        acb = drv->free_aiocb;
        drv->free_aiocb = acb->next;
    } else {
        acb = qemu_mallocz(drv->aiocb_size);
    }
    acb->bs = bs;
    acb->cb = cb;
    acb->opaque = opaque;
    return acb;
}

void qemu_aio_release(void *p)
{
    BlockDriverAIOCB *acb = p;
    BlockDriver *drv = acb->bs->drv;
    acb->next = drv->free_aiocb;
    drv->free_aiocb = acb;
}
B
bellard 已提交
1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612

/**************************************************************/
/* removable device support */

/**
 * Return TRUE if the media is present
 */
int bdrv_is_inserted(BlockDriverState *bs)
{
    BlockDriver *drv = bs->drv;
    int ret;
    if (!drv)
        return 0;
    if (!drv->bdrv_is_inserted)
        return 1;
    ret = drv->bdrv_is_inserted(bs);
    return ret;
}

/**
 * Return TRUE if the media changed since the last call to this
1613
 * function. It is currently only used for floppy disks
B
bellard 已提交
1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666
 */
int bdrv_media_changed(BlockDriverState *bs)
{
    BlockDriver *drv = bs->drv;
    int ret;

    if (!drv || !drv->bdrv_media_changed)
        ret = -ENOTSUP;
    else
        ret = drv->bdrv_media_changed(bs);
    if (ret == -ENOTSUP)
        ret = bs->media_changed;
    bs->media_changed = 0;
    return ret;
}

/**
 * If eject_flag is TRUE, eject the media. Otherwise, close the tray
 */
void bdrv_eject(BlockDriverState *bs, int eject_flag)
{
    BlockDriver *drv = bs->drv;
    int ret;

    if (!drv || !drv->bdrv_eject) {
        ret = -ENOTSUP;
    } else {
        ret = drv->bdrv_eject(bs, eject_flag);
    }
    if (ret == -ENOTSUP) {
        if (eject_flag)
            bdrv_close(bs);
    }
}

int bdrv_is_locked(BlockDriverState *bs)
{
    return bs->locked;
}

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

    bs->locked = locked;
    if (drv && drv->bdrv_set_locked) {
        drv->bdrv_set_locked(bs, locked);
    }
}
1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677

/* needed for generic scsi interface */

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

    if (drv && drv->bdrv_ioctl)
        return drv->bdrv_ioctl(bs, req, buf);
    return -ENOTSUP;
}
1678 1679 1680

int bdrv_sg_send_command(BlockDriverState *bs, void *buf, int count)
{
1681
    return bs->drv->bdrv_sg_send_command(bs, buf, count);
1682 1683 1684 1685
}

int bdrv_sg_recv_response(BlockDriverState *bs, void *buf, int count)
{
1686
    return bs->drv->bdrv_sg_recv_response(bs, buf, count);
1687 1688 1689 1690 1691
}

BlockDriverAIOCB *bdrv_sg_aio_read(BlockDriverState *bs, void *buf, int count,
                                   BlockDriverCompletionFunc *cb, void *opaque)
{
1692
    return bs->drv->bdrv_sg_aio_read(bs, buf, count, cb, opaque);
1693 1694 1695 1696 1697
}

BlockDriverAIOCB *bdrv_sg_aio_write(BlockDriverState *bs, void *buf, int count,
                                    BlockDriverCompletionFunc *cb, void *opaque)
{
1698
    return bs->drv->bdrv_sg_aio_write(bs, buf, count, cb, opaque);
1699
}