block.c 44.3 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 25 26 27 28 29
#include "config-host.h"
#ifdef _BSD
/* include native header before sys-queue.h */
#include <sys/queue.h>
#endif

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

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

B
bellard 已提交
41 42 43
#define SECTOR_BITS 9
#define SECTOR_SIZE (1 << SECTOR_BITS)

B
bellard 已提交
44 45 46 47 48 49
typedef struct BlockDriverAIOCBSync {
    BlockDriverAIOCB common;
    QEMUBH *bh;
    int ret;
} BlockDriverAIOCBSync;

50 51 52 53 54 55
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 已提交
56
static void bdrv_aio_cancel_em(BlockDriverAIOCB *acb);
57
static int bdrv_read_em(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
58 59 60
                        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 已提交
61

62 63
BlockDriverState *bdrv_first;

B
bellard 已提交
64 65
static BlockDriver *first_drv;

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

B
bellard 已提交
86 87 88 89 90 91
/* 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)
92
{
B
bellard 已提交
93 94 95 96 97 98 99 100 101 102 103 104 105
    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;
106 107 108 109 110 111 112 113 114
        p1 = strrchr(base_path, '/');
#ifdef _WIN32
        {
            const char *p2;
            p2 = strrchr(base_path, '\\');
            if (!p1 || p2 > p1)
                p1 = p2;
        }
#endif
B
bellard 已提交
115 116 117 118 119 120 121 122 123 124 125 126
        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);
127 128 129 130
    }
}


131
static void bdrv_register(BlockDriver *bdrv)
B
bellard 已提交
132
{
133
    if (!bdrv->bdrv_aio_read) {
B
bellard 已提交
134 135 136 137
        /* 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 已提交
138
        bdrv->aiocb_size = sizeof(BlockDriverAIOCBSync);
B
bellard 已提交
139 140 141 142 143
    } 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 已提交
144 145 146
    bdrv->next = first_drv;
    first_drv = bdrv;
}
B
bellard 已提交
147 148 149 150 151 152 153 154

/* 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 已提交
155 156 157 158 159 160 161
    if (device_name[0] != '\0') {
        /* insert at the end */
        pbs = &bdrv_first;
        while (*pbs != NULL)
            pbs = &(*pbs)->next;
        *pbs = bs;
    }
B
bellard 已提交
162 163 164
    return bs;
}

B
bellard 已提交
165 166 167 168 169 170 171 172 173 174
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;
}

175
int bdrv_create(BlockDriver *drv,
B
bellard 已提交
176 177 178 179 180 181 182 183
                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 已提交
184
#ifdef _WIN32
185
void get_tmp_filename(char *filename, int size)
B
bellard 已提交
186
{
187
    char temp_dir[MAX_PATH];
188

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

B
bellard 已提交
207
#ifdef _WIN32
B
bellard 已提交
208 209 210 211 212 213
static int is_windows_drive_prefix(const char *filename)
{
    return (((filename[0] >= 'a' && filename[0] <= 'z') ||
             (filename[0] >= 'A' && filename[0] <= 'Z')) &&
            filename[1] == ':');
}
214

B
bellard 已提交
215 216
static int is_windows_drive(const char *filename)
{
217
    if (is_windows_drive_prefix(filename) &&
B
bellard 已提交
218
        filename[2] == '\0')
B
bellard 已提交
219 220 221 222 223 224 225 226
        return 1;
    if (strstart(filename, "\\\\.\\", NULL) ||
        strstart(filename, "//./", NULL))
        return 1;
    return 0;
}
#endif

B
bellard 已提交
227 228 229 230 231 232
static BlockDriver *find_protocol(const char *filename)
{
    BlockDriver *drv1;
    char protocol[128];
    int len;
    const char *p;
B
bellard 已提交
233 234

#ifdef _WIN32
B
bellard 已提交
235 236
    if (is_windows_drive(filename) ||
        is_windows_drive_prefix(filename))
B
bellard 已提交
237 238
        return &bdrv_raw;
#endif
B
bellard 已提交
239 240 241 242 243 244 245 246 247
    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) {
248
        if (drv1->protocol_name &&
B
bellard 已提交
249 250 251 252 253 254
            !strcmp(drv1->protocol_name, protocol))
            return drv1;
    }
    return NULL;
}

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

B
bellard 已提交
264 265 266 267 268 269 270 271 272 273
    /* 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;
274
        if (stat(filename, &st) >= 0 &&
B
bellard 已提交
275 276 277 278 279
            (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode))) {
            return &bdrv_host_device;
        }
    }
#endif
280

B
bellard 已提交
281
    drv = find_protocol(filename);
B
bellard 已提交
282
    /* no need to test disk image formats for vvfat */
B
bellard 已提交
283 284
    if (drv == &bdrv_vvfat)
        return drv;
B
bellard 已提交
285

B
bellard 已提交
286 287 288 289 290 291 292 293 294
    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 已提交
295 296
    score_max = 0;
    for(drv1 = first_drv; drv1 != NULL; drv1 = drv1->next) {
B
bellard 已提交
297 298 299 300 301 302
        if (drv1->bdrv_probe) {
            score = drv1->bdrv_probe(buf, ret, filename);
            if (score > score_max) {
                score_max = score;
                drv = drv1;
            }
B
bellard 已提交
303
        }
B
bellard 已提交
304
    }
B
bellard 已提交
305 306 307
    return drv;
}

B
bellard 已提交
308
int bdrv_file_open(BlockDriverState **pbs, const char *filename, int flags)
B
bellard 已提交
309
{
B
bellard 已提交
310 311 312 313 314 315 316 317
    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;
318
    }
319
    bs->growable = 1;
B
bellard 已提交
320 321 322 323 324 325 326
    *pbs = bs;
    return 0;
}

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

B
bellard 已提交
329
int bdrv_open2(BlockDriverState *bs, const char *filename, int flags,
B
bellard 已提交
330 331
               BlockDriver *drv)
{
B
bellard 已提交
332
    int ret, open_flags;
333 334
    char tmp_filename[PATH_MAX];
    char backing_filename[PATH_MAX];
335

B
bellard 已提交
336 337 338
    bs->read_only = 0;
    bs->is_temporary = 0;
    bs->encrypted = 0;
339
    bs->valid_key = 0;
B
bellard 已提交
340

B
bellard 已提交
341
    if (flags & BDRV_O_SNAPSHOT) {
B
bellard 已提交
342 343
        BlockDriverState *bs1;
        int64_t total_size;
A
aliguori 已提交
344
        int is_protocol = 0;
345

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

B
bellard 已提交
349 350
        /* if there is a backing file, use it */
        bs1 = bdrv_new("");
351 352
        ret = bdrv_open(bs1, filename, 0);
        if (ret < 0) {
B
bellard 已提交
353
            bdrv_delete(bs1);
354
            return ret;
B
bellard 已提交
355
        }
B
bellard 已提交
356
        total_size = bdrv_getlength(bs1) >> SECTOR_BITS;
A
aliguori 已提交
357 358 359 360

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

B
bellard 已提交
361
        bdrv_delete(bs1);
362

B
bellard 已提交
363
        get_tmp_filename(tmp_filename, sizeof(tmp_filename));
A
aliguori 已提交
364 365 366 367 368 369 370 371

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

372 373 374 375
        ret = bdrv_create(&bdrv_qcow2, tmp_filename,
                          total_size, backing_filename, 0);
        if (ret < 0) {
            return ret;
B
bellard 已提交
376 377 378 379
        }
        filename = tmp_filename;
        bs->is_temporary = 1;
    }
B
bellard 已提交
380

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

433 434 435 436 437 438
    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 已提交
439
    return 0;
B
bellard 已提交
440 441 442 443
}

void bdrv_close(BlockDriverState *bs)
{
B
bellard 已提交
444
    if (bs->drv) {
B
bellard 已提交
445 446 447 448 449 450 451 452
        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 已提交
453
#endif
B
bellard 已提交
454 455
        bs->opaque = NULL;
        bs->drv = NULL;
B
bellard 已提交
456 457

        /* call the change callback */
B
bellard 已提交
458
        bs->media_changed = 1;
B
bellard 已提交
459 460 461 462 463 464 465
        if (bs->change_cb)
            bs->change_cb(bs->change_opaque);
    }
}

void bdrv_delete(BlockDriverState *bs)
{
466 467 468 469 470 471 472 473
    BlockDriverState **pbs;

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

B
bellard 已提交
474 475
    bdrv_close(bs);
    qemu_free(bs);
B
bellard 已提交
476 477
}

478 479 480
/* commit COW file into the raw image */
int bdrv_commit(BlockDriverState *bs)
{
B
bellard 已提交
481
    BlockDriver *drv = bs->drv;
B
bellard 已提交
482
    int64_t i, total_sectors;
B
bellard 已提交
483 484
    int n, j;
    unsigned char sector[512];
485

B
bellard 已提交
486 487
    if (!drv)
        return -ENOMEDIUM;
488 489

    if (bs->read_only) {
B
bellard 已提交
490
	return -EACCES;
491 492
    }

B
bellard 已提交
493 494 495
    if (!bs->backing_hd) {
	return -ENOTSUP;
    }
496

B
bellard 已提交
497 498
    total_sectors = bdrv_getlength(bs) >> SECTOR_BITS;
    for (i = 0; i < total_sectors;) {
B
bellard 已提交
499
        if (drv->bdrv_is_allocated(bs, i, 65536, &n)) {
B
bellard 已提交
500 501 502 503 504 505 506 507 508
            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++;
509
	    }
B
bellard 已提交
510 511 512
	} else {
            i += n;
        }
513
    }
514

B
bellard 已提交
515 516
    if (drv->bdrv_make_empty)
	return drv->bdrv_make_empty(bs);
517

518 519 520
    return 0;
}

521 522 523 524 525 526 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
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 已提交
554
/* return < 0 if error. See bdrv_write() for the return codes */
555
int bdrv_read(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
556 557
              uint8_t *buf, int nb_sectors)
{
B
bellard 已提交
558 559
    BlockDriver *drv = bs->drv;

B
bellard 已提交
560 561
    if (!drv)
        return -ENOMEDIUM;
562 563
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return -EIO;
B
bellard 已提交
564

B
bellard 已提交
565 566 567 568 569 570 571
    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 已提交
572
            return -EINVAL;
573 574 575
        else {
	    bs->rd_bytes += (unsigned) len;
	    bs->rd_ops ++;
B
bellard 已提交
576
            return 0;
577
	}
B
bellard 已提交
578 579
    } else {
        return drv->bdrv_read(bs, sector_num, buf, nb_sectors);
580
    }
B
bellard 已提交
581 582
}

583
/* Return < 0 if error. Important errors are:
B
bellard 已提交
584 585 586 587 588
  -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
*/
589
int bdrv_write(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
590 591
               const uint8_t *buf, int nb_sectors)
{
B
bellard 已提交
592
    BlockDriver *drv = bs->drv;
B
bellard 已提交
593 594
    if (!bs->drv)
        return -ENOMEDIUM;
B
bellard 已提交
595
    if (bs->read_only)
B
bellard 已提交
596
        return -EACCES;
597 598 599
    if (bdrv_check_request(bs, sector_num, nb_sectors))
        return -EIO;

B
bellard 已提交
600
    if (drv->bdrv_pwrite) {
601
        int ret, len, count = 0;
B
bellard 已提交
602
        len = nb_sectors * 512;
603 604 605 606 607 608 609 610 611 612 613 614
        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 已提交
615
    }
616
    return drv->bdrv_write(bs, sector_num, buf, nb_sectors);
B
bellard 已提交
617 618
}

619
static int bdrv_pread_em(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
620
                         uint8_t *buf, int count1)
B
bellard 已提交
621 622 623 624 625 626 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
{
    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;
}

663
static int bdrv_pwrite_em(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
664
                          const uint8_t *buf, int count1)
B
bellard 已提交
665 666 667 668 669 670 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
{
    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;
}

/**
712
 * Read with byte offsets (needed only for file protocols)
B
bellard 已提交
713
 */
714
int bdrv_pread(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
715 716 717 718 719
               void *buf1, int count1)
{
    BlockDriver *drv = bs->drv;

    if (!drv)
B
bellard 已提交
720
        return -ENOMEDIUM;
721 722 723
    if (bdrv_check_byte_request(bs, offset, count1))
        return -EIO;

B
bellard 已提交
724
    if (!drv->bdrv_pread)
B
bellard 已提交
725
        return bdrv_pread_em(bs, offset, buf1, count1);
B
bellard 已提交
726 727 728
    return drv->bdrv_pread(bs, offset, buf1, count1);
}

729 730
/**
 * Write with byte offsets (needed only for file protocols)
B
bellard 已提交
731
 */
732
int bdrv_pwrite(BlockDriverState *bs, int64_t offset,
B
bellard 已提交
733 734 735 736 737
                const void *buf1, int count1)
{
    BlockDriver *drv = bs->drv;

    if (!drv)
B
bellard 已提交
738
        return -ENOMEDIUM;
739 740 741
    if (bdrv_check_byte_request(bs, offset, count1))
        return -EIO;

B
bellard 已提交
742
    if (!drv->bdrv_pwrite)
B
bellard 已提交
743
        return bdrv_pwrite_em(bs, offset, buf1, count1);
B
bellard 已提交
744 745 746 747 748 749 750 751 752 753
    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 已提交
754
        return -ENOMEDIUM;
B
bellard 已提交
755 756 757 758 759 760 761 762 763 764 765 766
    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 已提交
767
        return -ENOMEDIUM;
B
bellard 已提交
768 769 770 771 772
    if (!drv->bdrv_getlength) {
        /* legacy mode */
        return bs->total_sectors * SECTOR_SIZE;
    }
    return drv->bdrv_getlength(bs);
B
bellard 已提交
773 774
}

B
bellard 已提交
775
/* return 0 as number of sectors if no device present or error */
776
void bdrv_get_geometry(BlockDriverState *bs, uint64_t *nb_sectors_ptr)
B
bellard 已提交
777
{
B
bellard 已提交
778 779 780 781 782 783 784
    int64_t length;
    length = bdrv_getlength(bs);
    if (length < 0)
        length = 0;
    else
        length = length >> SECTOR_BITS;
    *nb_sectors_ptr = length;
B
bellard 已提交
785
}
B
bellard 已提交
786

787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807
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 已提交
808
    uint64_t nb_sectors;
809 810 811 812 813 814 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

    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 已提交
848
    uint64_t nb_sectors;
849 850 851 852 853 854 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

    /* 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);
    }
}

903
void bdrv_set_geometry_hint(BlockDriverState *bs,
B
bellard 已提交
904 905 906 907 908 909 910 911 912 913 914 915 916 917
                            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 已提交
918 919 920 921 922
void bdrv_set_translation_hint(BlockDriverState *bs, int translation)
{
    bs->translation = translation;
}

923
void bdrv_get_geometry_hint(BlockDriverState *bs,
B
bellard 已提交
924 925 926 927 928 929 930 931 932 933 934 935
                            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 已提交
936 937 938 939 940
int bdrv_get_translation_hint(BlockDriverState *bs)
{
    return bs->translation;
}

B
bellard 已提交
941 942 943 944 945 946 947 948 949 950
int bdrv_is_removable(BlockDriverState *bs)
{
    return bs->removable;
}

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

951 952 953 954 955
int bdrv_is_sg(BlockDriverState *bs)
{
    return bs->sg;
}

B
bellard 已提交
956
/* XXX: no longer used */
957
void bdrv_set_change_cb(BlockDriverState *bs,
B
bellard 已提交
958 959 960 961 962 963
                        void (*change_cb)(void *opaque), void *opaque)
{
    bs->change_cb = change_cb;
    bs->change_opaque = opaque;
}

B
bellard 已提交
964 965 966 967 968 969 970
int bdrv_is_encrypted(BlockDriverState *bs)
{
    if (bs->backing_hd && bs->backing_hd->encrypted)
        return 1;
    return bs->encrypted;
}

971 972 973 974 975 976 977 978 979
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 已提交
980 981 982 983 984 985 986 987 988 989 990 991
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;
992
    ret = bs->drv->bdrv_set_key(bs, key);
993 994 995 996 997 998 999 1000 1001
    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);
    }
1002
    return ret;
B
bellard 已提交
1003 1004 1005 1006
}

void bdrv_get_format(BlockDriverState *bs, char *buf, int buf_size)
{
B
bellard 已提交
1007
    if (!bs->drv) {
B
bellard 已提交
1008 1009 1010 1011 1012 1013
        buf[0] = '\0';
    } else {
        pstrcpy(buf, buf_size, bs->drv->format_name);
    }
}

1014
void bdrv_iterate_format(void (*it)(void *opaque, const char *name),
B
bellard 已提交
1015 1016 1017 1018 1019 1020 1021 1022 1023
                         void *opaque)
{
    BlockDriver *drv;

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

B
bellard 已提交
1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034
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;
}

1035
void bdrv_iterate(void (*it)(void *opaque, BlockDriverState *bs), void *opaque)
B
bellard 已提交
1036 1037 1038 1039
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
1040
        it(opaque, bs);
B
bellard 已提交
1041 1042 1043
    }
}

B
bellard 已提交
1044 1045 1046 1047 1048
const char *bdrv_get_device_name(BlockDriverState *bs)
{
    return bs->device_name;
}

P
pbrook 已提交
1049 1050 1051 1052 1053 1054 1055 1056
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 已提交
1057 1058 1059 1060 1061 1062 1063 1064 1065 1066
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);
}

1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
/*
 * 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);
}

B
bellard 已提交
1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115
void bdrv_info(void)
{
    BlockDriverState *bs;

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
        term_printf("%s:", bs->device_name);
        term_printf(" type=");
        switch(bs->type) {
        case BDRV_TYPE_HD:
            term_printf("hd");
            break;
        case BDRV_TYPE_CDROM:
            term_printf("cdrom");
            break;
        case BDRV_TYPE_FLOPPY:
            term_printf("floppy");
            break;
        }
        term_printf(" removable=%d", bs->removable);
        if (bs->removable) {
            term_printf(" locked=%d", bs->locked);
        }
B
bellard 已提交
1116
        if (bs->drv) {
1117 1118 1119 1120 1121 1122
            term_printf(" file=");
	    term_print_filename(bs->filename);
            if (bs->backing_file[0] != '\0') {
                term_printf(" backing_file=");
		term_print_filename(bs->backing_file);
	    }
B
bellard 已提交
1123
            term_printf(" ro=%d", bs->read_only);
B
bellard 已提交
1124
            term_printf(" drv=%s", bs->drv->format_name);
1125
            term_printf(" encrypted=%d", bdrv_is_encrypted(bs));
B
bellard 已提交
1126 1127 1128 1129 1130 1131
        } else {
            term_printf(" [not inserted]");
        }
        term_printf("\n");
    }
}
1132 1133 1134 1135 1136

/* The "info blockstats" command. */
void bdrv_info_stats (void)
{
    BlockDriverState *bs;
1137
    BlockDriverInfo bdi;
1138 1139 1140 1141 1142 1143 1144

    for (bs = bdrv_first; bs != NULL; bs = bs->next) {
	term_printf ("%s:"
		     " rd_bytes=%" PRIu64
		     " wr_bytes=%" PRIu64
		     " rd_operations=%" PRIu64
		     " wr_operations=%" PRIu64
1145
                     ,
1146 1147 1148
		     bs->device_name,
		     bs->rd_bytes, bs->wr_bytes,
		     bs->rd_ops, bs->wr_ops);
1149
        if (bdrv_get_info(bs, &bdi) == 0)
1150 1151 1152
            term_printf(" high=%" PRId64
                        " bytes_free=%" PRId64,
                        bdi.highest_alloc, bdi.num_free_bytes);
1153
        term_printf("\n");
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;
}