qcow.c 29.1 KB
Newer Older
B
bellard 已提交
1 2
/*
 * Block driver for the QCOW format
3
 *
B
bellard 已提交
4
 * Copyright (c) 2004-2006 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.
 */
P
pbrook 已提交
24
#include "qemu-common.h"
25
#include "block/block_int.h"
26
#include "qemu/module.h"
B
bellard 已提交
27
#include <zlib.h>
28
#include "qemu/aes.h"
29
#include "migration/migration.h"
B
bellard 已提交
30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50

/**************************************************************/
/* QEMU COW block driver with compression and encryption support */

#define QCOW_MAGIC (('Q' << 24) | ('F' << 16) | ('I' << 8) | 0xfb)
#define QCOW_VERSION 1

#define QCOW_CRYPT_NONE 0
#define QCOW_CRYPT_AES  1

#define QCOW_OFLAG_COMPRESSED (1LL << 63)

typedef struct QCowHeader {
    uint32_t magic;
    uint32_t version;
    uint64_t backing_file_offset;
    uint32_t backing_file_size;
    uint32_t mtime;
    uint64_t size; /* in bytes */
    uint8_t cluster_bits;
    uint8_t l2_bits;
51
    uint16_t padding;
B
bellard 已提交
52 53
    uint32_t crypt_method;
    uint64_t l1_table_offset;
54
} QEMU_PACKED QCowHeader;
B
bellard 已提交
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77

#define L2_CACHE_SIZE 16

typedef struct BDRVQcowState {
    int cluster_bits;
    int cluster_size;
    int cluster_sectors;
    int l2_bits;
    int l2_size;
    int l1_size;
    uint64_t cluster_offset_mask;
    uint64_t l1_table_offset;
    uint64_t *l1_table;
    uint64_t *l2_cache;
    uint64_t l2_cache_offsets[L2_CACHE_SIZE];
    uint32_t l2_cache_counts[L2_CACHE_SIZE];
    uint8_t *cluster_cache;
    uint8_t *cluster_data;
    uint64_t cluster_cache_offset;
    uint32_t crypt_method; /* current crypt method, 0 if no key yet */
    uint32_t crypt_method_header;
    AES_KEY aes_encrypt_key;
    AES_KEY aes_decrypt_key;
K
Kevin Wolf 已提交
78
    CoMutex lock;
K
Kevin Wolf 已提交
79
    Error *migration_blocker;
B
bellard 已提交
80 81
} BDRVQcowState;

82
static int decompress_cluster(BlockDriverState *bs, uint64_t cluster_offset);
B
bellard 已提交
83 84 85 86

static int qcow_probe(const uint8_t *buf, int buf_size, const char *filename)
{
    const QCowHeader *cow_header = (const void *)buf;
87

B
bellard 已提交
88 89
    if (buf_size >= sizeof(QCowHeader) &&
        be32_to_cpu(cow_header->magic) == QCOW_MAGIC &&
90
        be32_to_cpu(cow_header->version) == QCOW_VERSION)
B
bellard 已提交
91 92 93 94 95
        return 100;
    else
        return 0;
}

M
Max Reitz 已提交
96 97
static int qcow_open(BlockDriverState *bs, QDict *options, int flags,
                     Error **errp)
B
bellard 已提交
98 99
{
    BDRVQcowState *s = bs->opaque;
100
    int len, i, shift, ret;
B
bellard 已提交
101
    QCowHeader header;
B
bellard 已提交
102

103 104
    ret = bdrv_pread(bs->file, 0, &header, sizeof(header));
    if (ret < 0) {
B
bellard 已提交
105
        goto fail;
106
    }
B
bellard 已提交
107 108 109 110 111 112 113 114
    be32_to_cpus(&header.magic);
    be32_to_cpus(&header.version);
    be64_to_cpus(&header.backing_file_offset);
    be32_to_cpus(&header.backing_file_size);
    be32_to_cpus(&header.mtime);
    be64_to_cpus(&header.size);
    be32_to_cpus(&header.crypt_method);
    be64_to_cpus(&header.l1_table_offset);
115

116
    if (header.magic != QCOW_MAGIC) {
P
Paolo Bonzini 已提交
117 118
        error_setg(errp, "Image not in qcow format");
        ret = -EINVAL;
119 120 121 122
        goto fail;
    }
    if (header.version != QCOW_VERSION) {
        char version[64];
123 124
        snprintf(version, sizeof(version), "QCOW version %" PRIu32,
                 header.version);
P
Paolo Bonzini 已提交
125 126
        error_set(errp, QERR_UNKNOWN_BLOCK_FORMAT_FEATURE,
                  bs->device_name, "qcow", version);
127
        ret = -ENOTSUP;
B
bellard 已提交
128
        goto fail;
129 130
    }

K
Kevin Wolf 已提交
131 132
    if (header.size <= 1) {
        error_setg(errp, "Image size is too small (must be at least 2 bytes)");
133
        ret = -EINVAL;
B
bellard 已提交
134
        goto fail;
135
    }
K
Kevin Wolf 已提交
136 137 138 139 140 141
    if (header.cluster_bits < 9 || header.cluster_bits > 16) {
        error_setg(errp, "Cluster size must be between 512 and 64k");
        ret = -EINVAL;
        goto fail;
    }

142 143 144 145 146 147 148 149
    /* l2_bits specifies number of entries; storing a uint64_t in each entry,
     * so bytes = num_entries << 3. */
    if (header.l2_bits < 9 - 3 || header.l2_bits > 16 - 3) {
        error_setg(errp, "L2 table size must be between 512 and 64k");
        ret = -EINVAL;
        goto fail;
    }

150
    if (header.crypt_method > QCOW_CRYPT_AES) {
P
Paolo Bonzini 已提交
151
        error_setg(errp, "invalid encryption method in qcow header");
152
        ret = -EINVAL;
B
bellard 已提交
153
        goto fail;
154
    }
B
bellard 已提交
155
    s->crypt_method_header = header.crypt_method;
156
    if (s->crypt_method_header) {
B
bellard 已提交
157
        bs->encrypted = 1;
158
    }
B
bellard 已提交
159 160 161 162 163 164 165 166 167 168 169 170 171
    s->cluster_bits = header.cluster_bits;
    s->cluster_size = 1 << s->cluster_bits;
    s->cluster_sectors = 1 << (s->cluster_bits - 9);
    s->l2_bits = header.l2_bits;
    s->l2_size = 1 << s->l2_bits;
    bs->total_sectors = header.size / 512;
    s->cluster_offset_mask = (1LL << (63 - s->cluster_bits)) - 1;

    /* read the level 1 table */
    shift = s->cluster_bits + s->l2_bits;
    s->l1_size = (header.size + (1LL << shift) - 1) >> shift;

    s->l1_table_offset = header.l1_table_offset;
172
    s->l1_table = g_malloc(s->l1_size * sizeof(uint64_t));
173 174 175 176

    ret = bdrv_pread(bs->file, s->l1_table_offset, s->l1_table,
               s->l1_size * sizeof(uint64_t));
    if (ret < 0) {
B
bellard 已提交
177
        goto fail;
178 179
    }

B
bellard 已提交
180 181 182 183
    for(i = 0;i < s->l1_size; i++) {
        be64_to_cpus(&s->l1_table[i]);
    }
    /* alloc L2 cache */
184 185 186
    s->l2_cache = g_malloc(s->l2_size * L2_CACHE_SIZE * sizeof(uint64_t));
    s->cluster_cache = g_malloc(s->cluster_size);
    s->cluster_data = g_malloc(s->cluster_size);
B
bellard 已提交
187
    s->cluster_cache_offset = -1;
188

B
bellard 已提交
189 190 191
    /* read the backing file name */
    if (header.backing_file_offset != 0) {
        len = header.backing_file_size;
192
        if (len > 1023) {
B
bellard 已提交
193
            len = 1023;
194 195 196 197
        }
        ret = bdrv_pread(bs->file, header.backing_file_offset,
                   bs->backing_file, len);
        if (ret < 0) {
B
bellard 已提交
198
            goto fail;
199
        }
B
bellard 已提交
200 201
        bs->backing_file[len] = '\0';
    }
S
Scott Wood 已提交
202

K
Kevin Wolf 已提交
203 204 205 206 207 208
    /* Disable migration when qcow images are used */
    error_set(&s->migration_blocker,
              QERR_BLOCK_FORMAT_FEATURE_NOT_SUPPORTED,
              "qcow", bs->device_name, "live migration");
    migrate_add_blocker(s->migration_blocker);

S
Scott Wood 已提交
209
    qemu_co_mutex_init(&s->lock);
B
bellard 已提交
210 211 212
    return 0;

 fail:
213 214 215 216
    g_free(s->l1_table);
    g_free(s->l2_cache);
    g_free(s->cluster_cache);
    g_free(s->cluster_data);
217
    return ret;
B
bellard 已提交
218 219
}

J
Jeff Cody 已提交
220 221 222 223 224 225 226 227 228

/* We have nothing to do for QCOW reopen, stubs just return
 * success */
static int qcow_reopen_prepare(BDRVReopenState *state,
                               BlockReopenQueue *queue, Error **errp)
{
    return 0;
}

B
bellard 已提交
229 230 231 232 233
static int qcow_set_key(BlockDriverState *bs, const char *key)
{
    BDRVQcowState *s = bs->opaque;
    uint8_t keybuf[16];
    int len, i;
234

B
bellard 已提交
235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269
    memset(keybuf, 0, 16);
    len = strlen(key);
    if (len > 16)
        len = 16;
    /* XXX: we could compress the chars to 7 bits to increase
       entropy */
    for(i = 0;i < len;i++) {
        keybuf[i] = key[i];
    }
    s->crypt_method = s->crypt_method_header;

    if (AES_set_encrypt_key(keybuf, 128, &s->aes_encrypt_key) != 0)
        return -1;
    if (AES_set_decrypt_key(keybuf, 128, &s->aes_decrypt_key) != 0)
        return -1;
    return 0;
}

/* The crypt function is compatible with the linux cryptoloop
   algorithm for < 4 GB images. NOTE: out_buf == in_buf is
   supported */
static void encrypt_sectors(BDRVQcowState *s, int64_t sector_num,
                            uint8_t *out_buf, const uint8_t *in_buf,
                            int nb_sectors, int enc,
                            const AES_KEY *key)
{
    union {
        uint64_t ll[2];
        uint8_t b[16];
    } ivec;
    int i;

    for(i = 0; i < nb_sectors; i++) {
        ivec.ll[0] = cpu_to_le64(sector_num);
        ivec.ll[1] = 0;
270
        AES_cbc_encrypt(in_buf, out_buf, 512, key,
B
bellard 已提交
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
                        ivec.b, enc);
        sector_num++;
        in_buf += 512;
        out_buf += 512;
    }
}

/* 'allocate' is:
 *
 * 0 to not allocate.
 *
 * 1 to allocate a normal cluster (for sector indexes 'n_start' to
 * 'n_end')
 *
 * 2 to allocate a compressed cluster of size
 * 'compressed_size'. 'compressed_size' must be > 0 and <
287
 * cluster_size
B
bellard 已提交
288 289 290 291 292 293 294 295 296 297 298 299 300
 *
 * return 0 if not allocated.
 */
static uint64_t get_cluster_offset(BlockDriverState *bs,
                                   uint64_t offset, int allocate,
                                   int compressed_size,
                                   int n_start, int n_end)
{
    BDRVQcowState *s = bs->opaque;
    int min_index, i, j, l1_index, l2_index;
    uint64_t l2_offset, *l2_table, cluster_offset, tmp;
    uint32_t min_count;
    int new_l2_table;
301

B
bellard 已提交
302 303 304 305 306 307 308
    l1_index = offset >> (s->l2_bits + s->cluster_bits);
    l2_offset = s->l1_table[l1_index];
    new_l2_table = 0;
    if (!l2_offset) {
        if (!allocate)
            return 0;
        /* allocate a new l2 entry */
309
        l2_offset = bdrv_getlength(bs->file);
B
bellard 已提交
310 311 312 313 314
        /* round to cluster size */
        l2_offset = (l2_offset + s->cluster_size - 1) & ~(s->cluster_size - 1);
        /* update the L1 entry */
        s->l1_table[l1_index] = l2_offset;
        tmp = cpu_to_be64(l2_offset);
315 316 317
        if (bdrv_pwrite_sync(bs->file,
                s->l1_table_offset + l1_index * sizeof(tmp),
                &tmp, sizeof(tmp)) < 0)
B
bellard 已提交
318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344
            return 0;
        new_l2_table = 1;
    }
    for(i = 0; i < L2_CACHE_SIZE; i++) {
        if (l2_offset == s->l2_cache_offsets[i]) {
            /* increment the hit count */
            if (++s->l2_cache_counts[i] == 0xffffffff) {
                for(j = 0; j < L2_CACHE_SIZE; j++) {
                    s->l2_cache_counts[j] >>= 1;
                }
            }
            l2_table = s->l2_cache + (i << s->l2_bits);
            goto found;
        }
    }
    /* not found: load a new entry in the least used one */
    min_index = 0;
    min_count = 0xffffffff;
    for(i = 0; i < L2_CACHE_SIZE; i++) {
        if (s->l2_cache_counts[i] < min_count) {
            min_count = s->l2_cache_counts[i];
            min_index = i;
        }
    }
    l2_table = s->l2_cache + (min_index << s->l2_bits);
    if (new_l2_table) {
        memset(l2_table, 0, s->l2_size * sizeof(uint64_t));
345 346
        if (bdrv_pwrite_sync(bs->file, l2_offset, l2_table,
                s->l2_size * sizeof(uint64_t)) < 0)
B
bellard 已提交
347 348
            return 0;
    } else {
349
        if (bdrv_pread(bs->file, l2_offset, l2_table, s->l2_size * sizeof(uint64_t)) !=
B
bellard 已提交
350 351 352 353 354 355 356 357
            s->l2_size * sizeof(uint64_t))
            return 0;
    }
    s->l2_cache_offsets[min_index] = l2_offset;
    s->l2_cache_counts[min_index] = 1;
 found:
    l2_index = (offset >> s->cluster_bits) & (s->l2_size - 1);
    cluster_offset = be64_to_cpu(l2_table[l2_index]);
358
    if (!cluster_offset ||
B
bellard 已提交
359 360 361 362 363 364 365 366 367
        ((cluster_offset & QCOW_OFLAG_COMPRESSED) && allocate == 1)) {
        if (!allocate)
            return 0;
        /* allocate a new cluster */
        if ((cluster_offset & QCOW_OFLAG_COMPRESSED) &&
            (n_end - n_start) < s->cluster_sectors) {
            /* if the cluster is already compressed, we must
               decompress it in the case it is not completely
               overwritten */
368
            if (decompress_cluster(bs, cluster_offset) < 0)
B
bellard 已提交
369
                return 0;
370
            cluster_offset = bdrv_getlength(bs->file);
371
            cluster_offset = (cluster_offset + s->cluster_size - 1) &
B
bellard 已提交
372 373
                ~(s->cluster_size - 1);
            /* write the cluster content */
374
            if (bdrv_pwrite(bs->file, cluster_offset, s->cluster_cache, s->cluster_size) !=
B
bellard 已提交
375 376 377
                s->cluster_size)
                return -1;
        } else {
378
            cluster_offset = bdrv_getlength(bs->file);
379 380 381 382
            if (allocate == 1) {
                /* round to cluster size */
                cluster_offset = (cluster_offset + s->cluster_size - 1) &
                    ~(s->cluster_size - 1);
383
                bdrv_truncate(bs->file, cluster_offset + s->cluster_size);
384 385 386 387 388 389 390 391 392 393 394 395 396
                /* if encrypted, we must initialize the cluster
                   content which won't be written */
                if (s->crypt_method &&
                    (n_end - n_start) < s->cluster_sectors) {
                    uint64_t start_sect;
                    start_sect = (offset & ~(s->cluster_size - 1)) >> 9;
                    memset(s->cluster_data + 512, 0x00, 512);
                    for(i = 0; i < s->cluster_sectors; i++) {
                        if (i < n_start || i >= n_end) {
                            encrypt_sectors(s, start_sect + i,
                                            s->cluster_data,
                                            s->cluster_data + 512, 1, 1,
                                            &s->aes_encrypt_key);
397
                            if (bdrv_pwrite(bs->file, cluster_offset + i * 512,
398 399 400
                                            s->cluster_data, 512) != 512)
                                return -1;
                        }
B
bellard 已提交
401 402
                    }
                }
403 404 405
            } else if (allocate == 2) {
                cluster_offset |= QCOW_OFLAG_COMPRESSED |
                    (uint64_t)compressed_size << (63 - s->cluster_bits);
B
bellard 已提交
406 407 408 409 410
            }
        }
        /* update L2 table */
        tmp = cpu_to_be64(cluster_offset);
        l2_table[l2_index] = tmp;
411 412
        if (bdrv_pwrite_sync(bs->file, l2_offset + l2_index * sizeof(tmp),
                &tmp, sizeof(tmp)) < 0)
B
bellard 已提交
413 414 415 416 417
            return 0;
    }
    return cluster_offset;
}

418
static int64_t coroutine_fn qcow_co_get_block_status(BlockDriverState *bs,
419
        int64_t sector_num, int nb_sectors, int *pnum)
B
bellard 已提交
420 421 422 423 424
{
    BDRVQcowState *s = bs->opaque;
    int index_in_cluster, n;
    uint64_t cluster_offset;

425
    qemu_co_mutex_lock(&s->lock);
B
bellard 已提交
426
    cluster_offset = get_cluster_offset(bs, sector_num << 9, 0, 0, 0, 0);
427
    qemu_co_mutex_unlock(&s->lock);
B
bellard 已提交
428 429 430 431 432
    index_in_cluster = sector_num & (s->cluster_sectors - 1);
    n = s->cluster_sectors - index_in_cluster;
    if (n > nb_sectors)
        n = nb_sectors;
    *pnum = n;
433 434 435 436 437 438 439 440
    if (!cluster_offset) {
        return 0;
    }
    if ((cluster_offset & QCOW_OFLAG_COMPRESSED) || s->crypt_method) {
        return BDRV_BLOCK_DATA;
    }
    cluster_offset |= (index_in_cluster << BDRV_SECTOR_BITS);
    return BDRV_BLOCK_DATA | BDRV_BLOCK_OFFSET_VALID | cluster_offset;
B
bellard 已提交
441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468
}

static int decompress_buffer(uint8_t *out_buf, int out_buf_size,
                             const uint8_t *buf, int buf_size)
{
    z_stream strm1, *strm = &strm1;
    int ret, out_len;

    memset(strm, 0, sizeof(*strm));

    strm->next_in = (uint8_t *)buf;
    strm->avail_in = buf_size;
    strm->next_out = out_buf;
    strm->avail_out = out_buf_size;

    ret = inflateInit2(strm, -12);
    if (ret != Z_OK)
        return -1;
    ret = inflate(strm, Z_FINISH);
    out_len = strm->next_out - out_buf;
    if ((ret != Z_STREAM_END && ret != Z_BUF_ERROR) ||
        out_len != out_buf_size) {
        inflateEnd(strm);
        return -1;
    }
    inflateEnd(strm);
    return 0;
}
469

470
static int decompress_cluster(BlockDriverState *bs, uint64_t cluster_offset)
B
bellard 已提交
471
{
472
    BDRVQcowState *s = bs->opaque;
B
bellard 已提交
473 474 475 476 477 478 479
    int ret, csize;
    uint64_t coffset;

    coffset = cluster_offset & s->cluster_offset_mask;
    if (s->cluster_cache_offset != coffset) {
        csize = cluster_offset >> (63 - s->cluster_bits);
        csize &= (s->cluster_size - 1);
480
        ret = bdrv_pread(bs->file, coffset, s->cluster_data, csize);
481
        if (ret != csize)
B
bellard 已提交
482 483 484 485 486 487 488 489 490 491
            return -1;
        if (decompress_buffer(s->cluster_cache, s->cluster_size,
                              s->cluster_data, csize) < 0) {
            return -1;
        }
        s->cluster_cache_offset = coffset;
    }
    return 0;
}

492
static coroutine_fn int qcow_co_readv(BlockDriverState *bs, int64_t sector_num,
F
Frediano Ziglio 已提交
493
                         int nb_sectors, QEMUIOVector *qiov)
B
bellard 已提交
494 495 496
{
    BDRVQcowState *s = bs->opaque;
    int index_in_cluster;
F
Frediano Ziglio 已提交
497
    int ret = 0, n;
498
    uint64_t cluster_offset;
F
Frediano Ziglio 已提交
499 500
    struct iovec hd_iov;
    QEMUIOVector hd_qiov;
F
Frediano Ziglio 已提交
501 502
    uint8_t *buf;
    void *orig_buf;
B
bellard 已提交
503

F
Frediano Ziglio 已提交
504 505 506 507 508
    if (qiov->niov > 1) {
        buf = orig_buf = qemu_blockalign(bs, qiov->size);
    } else {
        orig_buf = NULL;
        buf = (uint8_t *)qiov->iov->iov_base;
B
bellard 已提交
509
    }
510

F
Frediano Ziglio 已提交
511 512 513 514 515 516 517 518 519 520 521
    qemu_co_mutex_lock(&s->lock);

    while (nb_sectors != 0) {
        /* prepare next request */
        cluster_offset = get_cluster_offset(bs, sector_num << 9,
                                                 0, 0, 0, 0);
        index_in_cluster = sector_num & (s->cluster_sectors - 1);
        n = s->cluster_sectors - index_in_cluster;
        if (n > nb_sectors) {
            n = nb_sectors;
        }
522

F
Frediano Ziglio 已提交
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
        if (!cluster_offset) {
            if (bs->backing_hd) {
                /* read from the base image */
                hd_iov.iov_base = (void *)buf;
                hd_iov.iov_len = n * 512;
                qemu_iovec_init_external(&hd_qiov, &hd_iov, 1);
                qemu_co_mutex_unlock(&s->lock);
                ret = bdrv_co_readv(bs->backing_hd, sector_num,
                                    n, &hd_qiov);
                qemu_co_mutex_lock(&s->lock);
                if (ret < 0) {
                    goto fail;
                }
            } else {
                /* Note: in this case, no need to wait */
                memset(buf, 0, 512 * n);
            }
        } else if (cluster_offset & QCOW_OFLAG_COMPRESSED) {
            /* add AIO support for compressed blocks ? */
            if (decompress_cluster(bs, cluster_offset) < 0) {
                goto fail;
            }
            memcpy(buf,
                   s->cluster_cache + index_in_cluster * 512, 512 * n);
        } else {
            if ((cluster_offset & 511) != 0) {
                goto fail;
            }
            hd_iov.iov_base = (void *)buf;
F
Frediano Ziglio 已提交
552 553
            hd_iov.iov_len = n * 512;
            qemu_iovec_init_external(&hd_qiov, &hd_iov, 1);
K
Kevin Wolf 已提交
554
            qemu_co_mutex_unlock(&s->lock);
F
Frediano Ziglio 已提交
555 556
            ret = bdrv_co_readv(bs->file,
                                (cluster_offset >> 9) + index_in_cluster,
F
Frediano Ziglio 已提交
557
                                n, &hd_qiov);
K
Kevin Wolf 已提交
558 559
            qemu_co_mutex_lock(&s->lock);
            if (ret < 0) {
F
Frediano Ziglio 已提交
560 561 562 563 564 565
                break;
            }
            if (s->crypt_method) {
                encrypt_sectors(s, sector_num, buf, buf,
                                n, 0,
                                &s->aes_decrypt_key);
566 567
            }
        }
F
Frediano Ziglio 已提交
568
        ret = 0;
569

F
Frediano Ziglio 已提交
570 571 572
        nb_sectors -= n;
        sector_num += n;
        buf += n * 512;
573 574
    }

F
Frediano Ziglio 已提交
575
done:
K
Kevin Wolf 已提交
576 577
    qemu_co_mutex_unlock(&s->lock);

F
Frediano Ziglio 已提交
578
    if (qiov->niov > 1) {
579
        qemu_iovec_from_buf(qiov, 0, orig_buf, qiov->size);
F
Frediano Ziglio 已提交
580
        qemu_vfree(orig_buf);
K
Kevin Wolf 已提交
581 582
    }

K
Kevin Wolf 已提交
583
    return ret;
F
Frediano Ziglio 已提交
584 585 586 587

fail:
    ret = -EIO;
    goto done;
B
bellard 已提交
588 589
}

590
static coroutine_fn int qcow_co_writev(BlockDriverState *bs, int64_t sector_num,
F
Frediano Ziglio 已提交
591
                          int nb_sectors, QEMUIOVector *qiov)
B
bellard 已提交
592 593 594 595 596
{
    BDRVQcowState *s = bs->opaque;
    int index_in_cluster;
    uint64_t cluster_offset;
    const uint8_t *src_buf;
F
Frediano Ziglio 已提交
597
    int ret = 0, n;
F
Frediano Ziglio 已提交
598 599 600
    uint8_t *cluster_data = NULL;
    struct iovec hd_iov;
    QEMUIOVector hd_qiov;
F
Frediano Ziglio 已提交
601 602
    uint8_t *buf;
    void *orig_buf;
603

F
Frediano Ziglio 已提交
604
    s->cluster_cache_offset = -1; /* disable compressed cache */
605

F
Frediano Ziglio 已提交
606 607
    if (qiov->niov > 1) {
        buf = orig_buf = qemu_blockalign(bs, qiov->size);
608
        qemu_iovec_to_buf(qiov, 0, buf, qiov->size);
B
bellard 已提交
609
    } else {
F
Frediano Ziglio 已提交
610 611
        orig_buf = NULL;
        buf = (uint8_t *)qiov->iov->iov_base;
B
bellard 已提交
612
    }
613

K
Kevin Wolf 已提交
614
    qemu_co_mutex_lock(&s->lock);
615

F
Frediano Ziglio 已提交
616
    while (nb_sectors != 0) {
B
bellard 已提交
617

F
Frediano Ziglio 已提交
618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
        index_in_cluster = sector_num & (s->cluster_sectors - 1);
        n = s->cluster_sectors - index_in_cluster;
        if (n > nb_sectors) {
            n = nb_sectors;
        }
        cluster_offset = get_cluster_offset(bs, sector_num << 9, 1, 0,
                                            index_in_cluster,
                                            index_in_cluster + n);
        if (!cluster_offset || (cluster_offset & 511) != 0) {
            ret = -EIO;
            break;
        }
        if (s->crypt_method) {
            if (!cluster_data) {
                cluster_data = g_malloc0(s->cluster_size);
            }
            encrypt_sectors(s, sector_num, cluster_data, buf,
                            n, 1, &s->aes_encrypt_key);
            src_buf = cluster_data;
        } else {
            src_buf = buf;
        }
B
bellard 已提交
640

F
Frediano Ziglio 已提交
641 642 643 644 645 646 647 648 649 650 651 652
        hd_iov.iov_base = (void *)src_buf;
        hd_iov.iov_len = n * 512;
        qemu_iovec_init_external(&hd_qiov, &hd_iov, 1);
        qemu_co_mutex_unlock(&s->lock);
        ret = bdrv_co_writev(bs->file,
                             (cluster_offset >> 9) + index_in_cluster,
                             n, &hd_qiov);
        qemu_co_mutex_lock(&s->lock);
        if (ret < 0) {
            break;
        }
        ret = 0;
653

F
Frediano Ziglio 已提交
654 655 656 657
        nb_sectors -= n;
        sector_num += n;
        buf += n * 512;
    }
K
Kevin Wolf 已提交
658
    qemu_co_mutex_unlock(&s->lock);
659

F
Frediano Ziglio 已提交
660 661
    if (qiov->niov > 1) {
        qemu_vfree(orig_buf);
K
Kevin Wolf 已提交
662
    }
663
    g_free(cluster_data);
K
Kevin Wolf 已提交
664

K
Kevin Wolf 已提交
665
    return ret;
B
bellard 已提交
666 667
}

B
bellard 已提交
668
static void qcow_close(BlockDriverState *bs)
B
bellard 已提交
669 670
{
    BDRVQcowState *s = bs->opaque;
K
Kevin Wolf 已提交
671

672 673 674 675
    g_free(s->l1_table);
    g_free(s->l2_cache);
    g_free(s->cluster_cache);
    g_free(s->cluster_data);
K
Kevin Wolf 已提交
676 677 678

    migrate_del_blocker(s->migration_blocker);
    error_free(s->migration_blocker);
B
bellard 已提交
679 680
}

681 682
static int qcow_create(const char *filename, QEMUOptionParameter *options,
                       Error **errp)
B
bellard 已提交
683
{
684
    int header_size, backing_filename_len, l1_size, shift, i;
B
bellard 已提交
685
    QCowHeader header;
686
    uint8_t *tmp;
687 688 689
    int64_t total_size = 0;
    const char *backing_file = NULL;
    int flags = 0;
690
    Error *local_err = NULL;
691
    int ret;
692
    BlockDriverState *qcow_bs;
693 694 695 696 697 698 699 700 701 702 703 704

    /* Read out options */
    while (options && options->name) {
        if (!strcmp(options->name, BLOCK_OPT_SIZE)) {
            total_size = options->value.n / 512;
        } else if (!strcmp(options->name, BLOCK_OPT_BACKING_FILE)) {
            backing_file = options->value.s;
        } else if (!strcmp(options->name, BLOCK_OPT_ENCRYPT)) {
            flags |= options->value.n ? BLOCK_FLAG_ENCRYPT : 0;
        }
        options++;
    }
B
bellard 已提交
705

706
    ret = bdrv_create_file(filename, options, &local_err);
707
    if (ret < 0) {
P
Paolo Bonzini 已提交
708
        error_propagate(errp, local_err);
709 710 711
        return ret;
    }

M
Max Reitz 已提交
712 713 714
    qcow_bs = NULL;
    ret = bdrv_open(&qcow_bs, filename, NULL, NULL,
                    BDRV_O_RDWR | BDRV_O_PROTOCOL, NULL, &local_err);
715
    if (ret < 0) {
P
Paolo Bonzini 已提交
716
        error_propagate(errp, local_err);
717 718 719 720 721 722 723 724
        return ret;
    }

    ret = bdrv_truncate(qcow_bs, 0);
    if (ret < 0) {
        goto exit;
    }

B
bellard 已提交
725 726 727 728 729 730 731
    memset(&header, 0, sizeof(header));
    header.magic = cpu_to_be32(QCOW_MAGIC);
    header.version = cpu_to_be32(QCOW_VERSION);
    header.size = cpu_to_be64(total_size * 512);
    header_size = sizeof(header);
    backing_filename_len = 0;
    if (backing_file) {
A
aurel32 已提交
732 733 734 735 736 737 738 739 740
        if (strcmp(backing_file, "fat:")) {
            header.backing_file_offset = cpu_to_be64(header_size);
            backing_filename_len = strlen(backing_file);
            header.backing_file_size = cpu_to_be32(backing_filename_len);
            header_size += backing_filename_len;
        } else {
            /* special backing file for vvfat */
            backing_file = NULL;
        }
B
bellard 已提交
741
        header.cluster_bits = 9; /* 512 byte cluster to avoid copying
D
Deepak Kathayat 已提交
742
                                    unmodified sectors */
B
bellard 已提交
743 744 745 746 747 748 749 750 751 752
        header.l2_bits = 12; /* 32 KB L2 tables */
    } else {
        header.cluster_bits = 12; /* 4 KB clusters */
        header.l2_bits = 9; /* 4 KB L2 tables */
    }
    header_size = (header_size + 7) & ~7;
    shift = header.cluster_bits + header.l2_bits;
    l1_size = ((total_size * 512) + (1LL << shift) - 1) >> shift;

    header.l1_table_offset = cpu_to_be64(header_size);
753
    if (flags & BLOCK_FLAG_ENCRYPT) {
B
bellard 已提交
754 755 756 757
        header.crypt_method = cpu_to_be32(QCOW_CRYPT_AES);
    } else {
        header.crypt_method = cpu_to_be32(QCOW_CRYPT_NONE);
    }
758

B
bellard 已提交
759
    /* write all the data */
760
    ret = bdrv_pwrite(qcow_bs, 0, &header, sizeof(header));
761 762 763 764
    if (ret != sizeof(header)) {
        goto exit;
    }

B
bellard 已提交
765
    if (backing_file) {
766 767
        ret = bdrv_pwrite(qcow_bs, sizeof(header),
            backing_file, backing_filename_len);
768 769 770
        if (ret != backing_filename_len) {
            goto exit;
        }
B
bellard 已提交
771
    }
772 773 774 775 776 777 778 779

    tmp = g_malloc0(BDRV_SECTOR_SIZE);
    for (i = 0; i < ((sizeof(uint64_t)*l1_size + BDRV_SECTOR_SIZE - 1)/
        BDRV_SECTOR_SIZE); i++) {
        ret = bdrv_pwrite(qcow_bs, header_size +
            BDRV_SECTOR_SIZE*i, tmp, BDRV_SECTOR_SIZE);
        if (ret != BDRV_SECTOR_SIZE) {
            g_free(tmp);
780 781
            goto exit;
        }
B
bellard 已提交
782
    }
783

784
    g_free(tmp);
785 786
    ret = 0;
exit:
F
Fam Zheng 已提交
787
    bdrv_unref(qcow_bs);
788
    return ret;
B
bellard 已提交
789 790
}

B
bellard 已提交
791
static int qcow_make_empty(BlockDriverState *bs)
792 793 794
{
    BDRVQcowState *s = bs->opaque;
    uint32_t l1_length = s->l1_size * sizeof(uint64_t);
B
bellard 已提交
795
    int ret;
796 797

    memset(s->l1_table, 0, l1_length);
798 799 800
    if (bdrv_pwrite_sync(bs->file, s->l1_table_offset, s->l1_table,
            l1_length) < 0)
        return -1;
801
    ret = bdrv_truncate(bs->file, s->l1_table_offset + l1_length);
B
bellard 已提交
802 803
    if (ret < 0)
        return ret;
804 805 806 807 808 809 810 811

    memset(s->l2_cache, 0, s->l2_size * L2_CACHE_SIZE * sizeof(uint64_t));
    memset(s->l2_cache_offsets, 0, L2_CACHE_SIZE * sizeof(uint64_t));
    memset(s->l2_cache_counts, 0, L2_CACHE_SIZE * sizeof(uint32_t));

    return 0;
}

B
bellard 已提交
812 813
/* XXX: put compressed sectors first, then all the cluster aligned
   tables to avoid losing bytes in alignment */
814
static int qcow_write_compressed(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
815
                                 const uint8_t *buf, int nb_sectors)
B
bellard 已提交
816 817 818 819 820 821 822
{
    BDRVQcowState *s = bs->opaque;
    z_stream strm;
    int ret, out_len;
    uint8_t *out_buf;
    uint64_t cluster_offset;

823 824 825 826 827 828 829 830 831 832 833 834 835 836 837
    if (nb_sectors != s->cluster_sectors) {
        ret = -EINVAL;

        /* Zero-pad last write if image size is not cluster aligned */
        if (sector_num + nb_sectors == bs->total_sectors &&
            nb_sectors < s->cluster_sectors) {
            uint8_t *pad_buf = qemu_blockalign(bs, s->cluster_size);
            memset(pad_buf, 0, s->cluster_size);
            memcpy(pad_buf, buf, nb_sectors * BDRV_SECTOR_SIZE);
            ret = qcow_write_compressed(bs, sector_num,
                                        pad_buf, s->cluster_sectors);
            qemu_vfree(pad_buf);
        }
        return ret;
    }
B
bellard 已提交
838

839
    out_buf = g_malloc(s->cluster_size + (s->cluster_size / 1000) + 128);
B
bellard 已提交
840 841 842 843

    /* best compression, small window, no zlib header */
    memset(&strm, 0, sizeof(strm));
    ret = deflateInit2(&strm, Z_DEFAULT_COMPRESSION,
844
                       Z_DEFLATED, -12,
B
bellard 已提交
845 846
                       9, Z_DEFAULT_STRATEGY);
    if (ret != 0) {
847 848
        ret = -EINVAL;
        goto fail;
B
bellard 已提交
849 850 851 852 853 854 855 856 857 858
    }

    strm.avail_in = s->cluster_size;
    strm.next_in = (uint8_t *)buf;
    strm.avail_out = s->cluster_size;
    strm.next_out = out_buf;

    ret = deflate(&strm, Z_FINISH);
    if (ret != Z_STREAM_END && ret != Z_OK) {
        deflateEnd(&strm);
859 860
        ret = -EINVAL;
        goto fail;
B
bellard 已提交
861 862 863 864 865 866 867
    }
    out_len = strm.next_out - out_buf;

    deflateEnd(&strm);

    if (ret != Z_STREAM_END || out_len >= s->cluster_size) {
        /* could not compress: write normal cluster */
868 869 870 871
        ret = bdrv_write(bs, sector_num, buf, s->cluster_sectors);
        if (ret < 0) {
            goto fail;
        }
B
bellard 已提交
872
    } else {
873
        cluster_offset = get_cluster_offset(bs, sector_num << 9, 2,
B
bellard 已提交
874
                                            out_len, 0, 0);
875 876 877 878 879
        if (cluster_offset == 0) {
            ret = -EIO;
            goto fail;
        }

B
bellard 已提交
880
        cluster_offset &= s->cluster_offset_mask;
881 882 883
        ret = bdrv_pwrite(bs->file, cluster_offset, out_buf, out_len);
        if (ret < 0) {
            goto fail;
B
bellard 已提交
884 885
        }
    }
886

887 888
    ret = 0;
fail:
889
    g_free(out_buf);
890
    return ret;
B
bellard 已提交
891 892
}

B
bellard 已提交
893 894 895 896 897 898 899
static int qcow_get_info(BlockDriverState *bs, BlockDriverInfo *bdi)
{
    BDRVQcowState *s = bs->opaque;
    bdi->cluster_size = s->cluster_size;
    return 0;
}

900 901

static QEMUOptionParameter qcow_create_options[] = {
902 903 904 905 906 907 908 909 910 911 912 913 914 915 916
    {
        .name = BLOCK_OPT_SIZE,
        .type = OPT_SIZE,
        .help = "Virtual disk size"
    },
    {
        .name = BLOCK_OPT_BACKING_FILE,
        .type = OPT_STRING,
        .help = "File name of a base image"
    },
    {
        .name = BLOCK_OPT_ENCRYPT,
        .type = OPT_FLAG,
        .help = "Encrypt the image"
    },
917 918 919
    { NULL }
};

920
static BlockDriver bdrv_qcow = {
921 922 923 924 925
    .format_name	= "qcow",
    .instance_size	= sizeof(BDRVQcowState),
    .bdrv_probe		= qcow_probe,
    .bdrv_open		= qcow_open,
    .bdrv_close		= qcow_close,
J
Jeff Cody 已提交
926
    .bdrv_reopen_prepare = qcow_reopen_prepare,
927
    .bdrv_create	= qcow_create,
928
    .bdrv_has_zero_init     = bdrv_has_zero_init_1,
929 930 931

    .bdrv_co_readv          = qcow_co_readv,
    .bdrv_co_writev         = qcow_co_writev,
932
    .bdrv_co_get_block_status   = qcow_co_get_block_status,
933 934 935 936 937

    .bdrv_set_key           = qcow_set_key,
    .bdrv_make_empty        = qcow_make_empty,
    .bdrv_write_compressed  = qcow_write_compressed,
    .bdrv_get_info          = qcow_get_info,
938 939

    .create_options = qcow_create_options,
B
bellard 已提交
940
};
941 942 943 944 945 946 947

static void bdrv_qcow_init(void)
{
    bdrv_register(&bdrv_qcow);
}

block_init(bdrv_qcow_init);