block-qcow.c 28.0 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"
B
bellard 已提交
25
#include "block_int.h"
B
bellard 已提交
26
#include <zlib.h>
B
bellard 已提交
27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
#include "aes.h"

/**************************************************************/
/* 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;
    uint32_t crypt_method;
    uint64_t l1_table_offset;
} QCowHeader;

#define L2_CACHE_SIZE 16

typedef struct BDRVQcowState {
B
bellard 已提交
56
    BlockDriverState *hd;
B
bellard 已提交
57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
    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;
} BDRVQcowState;

static int decompress_cluster(BDRVQcowState *s, uint64_t cluster_offset);

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

B
bellard 已提交
84 85
    if (buf_size >= sizeof(QCowHeader) &&
        be32_to_cpu(cow_header->magic) == QCOW_MAGIC &&
86
        be32_to_cpu(cow_header->version) == QCOW_VERSION)
B
bellard 已提交
87 88 89 90 91
        return 100;
    else
        return 0;
}

B
bellard 已提交
92
static int qcow_open(BlockDriverState *bs, const char *filename, int flags)
B
bellard 已提交
93 94
{
    BDRVQcowState *s = bs->opaque;
B
bellard 已提交
95
    int len, i, shift, ret;
B
bellard 已提交
96
    QCowHeader header;
B
bellard 已提交
97

98
    ret = bdrv_file_open(&s->hd, filename, flags);
B
bellard 已提交
99 100 101
    if (ret < 0)
        return ret;
    if (bdrv_pread(s->hd, 0, &header, sizeof(header)) != sizeof(header))
B
bellard 已提交
102 103 104 105 106 107 108 109 110
        goto fail;
    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);
111

B
bellard 已提交
112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136
    if (header.magic != QCOW_MAGIC || header.version != QCOW_VERSION)
        goto fail;
    if (header.size <= 1 || header.cluster_bits < 9)
        goto fail;
    if (header.crypt_method > QCOW_CRYPT_AES)
        goto fail;
    s->crypt_method_header = header.crypt_method;
    if (s->crypt_method_header)
        bs->encrypted = 1;
    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;
    s->l1_table = qemu_malloc(s->l1_size * sizeof(uint64_t));
    if (!s->l1_table)
        goto fail;
137
    if (bdrv_pread(s->hd, s->l1_table_offset, s->l1_table, s->l1_size * sizeof(uint64_t)) !=
B
bellard 已提交
138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
        s->l1_size * sizeof(uint64_t))
        goto fail;
    for(i = 0;i < s->l1_size; i++) {
        be64_to_cpus(&s->l1_table[i]);
    }
    /* alloc L2 cache */
    s->l2_cache = qemu_malloc(s->l2_size * L2_CACHE_SIZE * sizeof(uint64_t));
    if (!s->l2_cache)
        goto fail;
    s->cluster_cache = qemu_malloc(s->cluster_size);
    if (!s->cluster_cache)
        goto fail;
    s->cluster_data = qemu_malloc(s->cluster_size);
    if (!s->cluster_data)
        goto fail;
    s->cluster_cache_offset = -1;
154

B
bellard 已提交
155 156 157 158 159
    /* read the backing file name */
    if (header.backing_file_offset != 0) {
        len = header.backing_file_size;
        if (len > 1023)
            len = 1023;
B
bellard 已提交
160
        if (bdrv_pread(s->hd, header.backing_file_offset, bs->backing_file, len) != len)
B
bellard 已提交
161 162 163 164 165 166 167 168 169 170
            goto fail;
        bs->backing_file[len] = '\0';
    }
    return 0;

 fail:
    qemu_free(s->l1_table);
    qemu_free(s->l2_cache);
    qemu_free(s->cluster_cache);
    qemu_free(s->cluster_data);
B
bellard 已提交
171
    bdrv_delete(s->hd);
B
bellard 已提交
172 173 174 175 176 177 178 179
    return -1;
}

static int qcow_set_key(BlockDriverState *bs, const char *key)
{
    BDRVQcowState *s = bs->opaque;
    uint8_t keybuf[16];
    int len, i;
180

B
bellard 已提交
181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
    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;
#if 0
    /* test */
    {
        uint8_t in[16];
        uint8_t out[16];
        uint8_t tmp[16];
        for(i=0;i<16;i++)
            in[i] = i;
        AES_encrypt(in, tmp, &s->aes_encrypt_key);
        AES_decrypt(tmp, out, &s->aes_decrypt_key);
        for(i = 0; i < 16; i++)
            printf(" %02x", tmp[i]);
        printf("\n");
        for(i = 0; i < 16; i++)
            printf(" %02x", out[i]);
        printf("\n");
    }
#endif
    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;
234
        AES_cbc_encrypt(in_buf, out_buf, 512, key,
B
bellard 已提交
235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250
                        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 <
251
 * cluster_size
B
bellard 已提交
252 253 254 255 256 257 258 259 260 261 262 263 264
 *
 * 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;
265

B
bellard 已提交
266 267 268 269 270 271 272
    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 */
B
bellard 已提交
273
        l2_offset = bdrv_getlength(s->hd);
B
bellard 已提交
274 275 276 277 278
        /* 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);
279
        if (bdrv_pwrite(s->hd, s->l1_table_offset + l1_index * sizeof(tmp),
B
bellard 已提交
280
                        &tmp, sizeof(tmp)) != sizeof(tmp))
B
bellard 已提交
281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307
            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));
B
bellard 已提交
308
        if (bdrv_pwrite(s->hd, l2_offset, l2_table, s->l2_size * sizeof(uint64_t)) !=
B
bellard 已提交
309 310 311
            s->l2_size * sizeof(uint64_t))
            return 0;
    } else {
312
        if (bdrv_pread(s->hd, l2_offset, l2_table, s->l2_size * sizeof(uint64_t)) !=
B
bellard 已提交
313 314 315 316 317 318 319 320
            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]);
321
    if (!cluster_offset ||
B
bellard 已提交
322 323 324 325 326 327 328 329 330 331 332
        ((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 */
            if (decompress_cluster(s, cluster_offset) < 0)
                return 0;
B
bellard 已提交
333
            cluster_offset = bdrv_getlength(s->hd);
334
            cluster_offset = (cluster_offset + s->cluster_size - 1) &
B
bellard 已提交
335 336
                ~(s->cluster_size - 1);
            /* write the cluster content */
337
            if (bdrv_pwrite(s->hd, cluster_offset, s->cluster_cache, s->cluster_size) !=
B
bellard 已提交
338 339 340
                s->cluster_size)
                return -1;
        } else {
B
bellard 已提交
341
            cluster_offset = bdrv_getlength(s->hd);
342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361
            /* round to cluster size */
            cluster_offset = (cluster_offset + s->cluster_size - 1) &
                ~(s->cluster_size - 1);
            bdrv_truncate(s->hd, cluster_offset + s->cluster_size);
            /* 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);
                        if (bdrv_pwrite(s->hd, cluster_offset + i * 512,
                                        s->cluster_data, 512) != 512)
                            return -1;
B
bellard 已提交
362 363 364 365 366 367 368
                    }
                }
            }
        }
        /* update L2 table */
        tmp = cpu_to_be64(cluster_offset);
        l2_table[l2_index] = tmp;
369
        if (bdrv_pwrite(s->hd,
B
bellard 已提交
370
                        l2_offset + l2_index * sizeof(tmp), &tmp, sizeof(tmp)) != sizeof(tmp))
B
bellard 已提交
371 372 373 374 375
            return 0;
    }
    return cluster_offset;
}

376
static int qcow_is_allocated(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417
                             int nb_sectors, int *pnum)
{
    BDRVQcowState *s = bs->opaque;
    int index_in_cluster, n;
    uint64_t cluster_offset;

    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;
    *pnum = n;
    return (cluster_offset != 0);
}

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;
}
418

B
bellard 已提交
419 420 421 422 423 424 425 426 427
static int decompress_cluster(BDRVQcowState *s, uint64_t cluster_offset)
{
    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);
B
bellard 已提交
428
        ret = bdrv_pread(s->hd, coffset, s->cluster_data, csize);
429
        if (ret != csize)
B
bellard 已提交
430 431 432 433 434 435 436 437 438 439
            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;
}

B
bellard 已提交
440 441
#if 0

442
static int qcow_read(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
443 444 445 446 447
                     uint8_t *buf, int nb_sectors)
{
    BDRVQcowState *s = bs->opaque;
    int ret, index_in_cluster, n;
    uint64_t cluster_offset;
448

B
bellard 已提交
449 450 451 452 453 454 455
    while (nb_sectors > 0) {
        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;
        if (!cluster_offset) {
B
bellard 已提交
456 457 458 459 460 461 462 463
            if (bs->backing_hd) {
                /* read from the base image */
                ret = bdrv_read(bs->backing_hd, sector_num, buf, n);
                if (ret < 0)
                    return -1;
            } else {
                memset(buf, 0, 512 * n);
            }
B
bellard 已提交
464 465 466 467 468
        } else if (cluster_offset & QCOW_OFLAG_COMPRESSED) {
            if (decompress_cluster(s, cluster_offset) < 0)
                return -1;
            memcpy(buf, s->cluster_cache + index_in_cluster * 512, 512 * n);
        } else {
B
bellard 已提交
469
            ret = bdrv_pread(s->hd, cluster_offset + index_in_cluster * 512, buf, n * 512);
470
            if (ret != n * 512)
B
bellard 已提交
471 472
                return -1;
            if (s->crypt_method) {
473
                encrypt_sectors(s, sector_num, buf, buf, n, 0,
B
bellard 已提交
474 475 476 477 478 479 480 481 482
                                &s->aes_decrypt_key);
            }
        }
        nb_sectors -= n;
        sector_num += n;
        buf += n * 512;
    }
    return 0;
}
B
bellard 已提交
483
#endif
B
bellard 已提交
484

485
static int qcow_write(BlockDriverState *bs, int64_t sector_num,
B
bellard 已提交
486 487 488 489 490
                     const uint8_t *buf, int nb_sectors)
{
    BDRVQcowState *s = bs->opaque;
    int ret, index_in_cluster, n;
    uint64_t cluster_offset;
491

B
bellard 已提交
492 493 494 495 496
    while (nb_sectors > 0) {
        index_in_cluster = sector_num & (s->cluster_sectors - 1);
        n = s->cluster_sectors - index_in_cluster;
        if (n > nb_sectors)
            n = nb_sectors;
497 498
        cluster_offset = get_cluster_offset(bs, sector_num << 9, 1, 0,
                                            index_in_cluster,
B
bellard 已提交
499 500 501 502 503 504
                                            index_in_cluster + n);
        if (!cluster_offset)
            return -1;
        if (s->crypt_method) {
            encrypt_sectors(s, sector_num, s->cluster_data, buf, n, 1,
                            &s->aes_encrypt_key);
505
            ret = bdrv_pwrite(s->hd, cluster_offset + index_in_cluster * 512,
B
bellard 已提交
506
                              s->cluster_data, n * 512);
B
bellard 已提交
507
        } else {
B
bellard 已提交
508
            ret = bdrv_pwrite(s->hd, cluster_offset + index_in_cluster * 512, buf, n * 512);
B
bellard 已提交
509
        }
510
        if (ret != n * 512)
B
bellard 已提交
511 512 513 514 515 516 517 518 519
            return -1;
        nb_sectors -= n;
        sector_num += n;
        buf += n * 512;
    }
    s->cluster_cache_offset = -1; /* disable compressed cache */
    return 0;
}

520 521
typedef struct QCowAIOCB {
    BlockDriverAIOCB common;
B
bellard 已提交
522 523 524 525 526
    int64_t sector_num;
    uint8_t *buf;
    int nb_sectors;
    int n;
    uint64_t cluster_offset;
527
    uint8_t *cluster_data;
B
bellard 已提交
528 529 530 531 532
    BlockDriverAIOCB *hd_aiocb;
} QCowAIOCB;

static void qcow_aio_read_cb(void *opaque, int ret)
{
533 534
    QCowAIOCB *acb = opaque;
    BlockDriverState *bs = acb->common.bs;
B
bellard 已提交
535 536 537
    BDRVQcowState *s = bs->opaque;
    int index_in_cluster;

538
    acb->hd_aiocb = NULL;
B
bellard 已提交
539 540
    if (ret < 0) {
    fail:
541 542
        acb->common.cb(acb->common.opaque, ret);
        qemu_aio_release(acb);
B
bellard 已提交
543 544 545 546 547
        return;
    }

 redo:
    /* post process the read buffer */
548
    if (!acb->cluster_offset) {
B
bellard 已提交
549
        /* nothing to do */
550
    } else if (acb->cluster_offset & QCOW_OFLAG_COMPRESSED) {
B
bellard 已提交
551 552 553
        /* nothing to do */
    } else {
        if (s->crypt_method) {
554 555
            encrypt_sectors(s, acb->sector_num, acb->buf, acb->buf,
                            acb->n, 0,
B
bellard 已提交
556 557 558 559
                            &s->aes_decrypt_key);
        }
    }

560 561 562
    acb->nb_sectors -= acb->n;
    acb->sector_num += acb->n;
    acb->buf += acb->n * 512;
B
bellard 已提交
563

564
    if (acb->nb_sectors == 0) {
B
bellard 已提交
565
        /* request completed */
566 567
        acb->common.cb(acb->common.opaque, 0);
        qemu_aio_release(acb);
B
bellard 已提交
568 569
        return;
    }
570

B
bellard 已提交
571
    /* prepare next AIO request */
572
    acb->cluster_offset = get_cluster_offset(bs, acb->sector_num << 9,
573 574 575 576 577 578 579
                                             0, 0, 0, 0);
    index_in_cluster = acb->sector_num & (s->cluster_sectors - 1);
    acb->n = s->cluster_sectors - index_in_cluster;
    if (acb->n > acb->nb_sectors)
        acb->n = acb->nb_sectors;

    if (!acb->cluster_offset) {
B
bellard 已提交
580 581
        if (bs->backing_hd) {
            /* read from the base image */
582 583 584
            acb->hd_aiocb = bdrv_aio_read(bs->backing_hd,
                acb->sector_num, acb->buf, acb->n, qcow_aio_read_cb, acb);
            if (acb->hd_aiocb == NULL)
B
bellard 已提交
585 586 587
                goto fail;
        } else {
            /* Note: in this case, no need to wait */
588
            memset(acb->buf, 0, 512 * acb->n);
B
bellard 已提交
589 590
            goto redo;
        }
591
    } else if (acb->cluster_offset & QCOW_OFLAG_COMPRESSED) {
B
bellard 已提交
592
        /* add AIO support for compressed blocks ? */
593
        if (decompress_cluster(s, acb->cluster_offset) < 0)
B
bellard 已提交
594
            goto fail;
595
        memcpy(acb->buf,
596
               s->cluster_cache + index_in_cluster * 512, 512 * acb->n);
B
bellard 已提交
597 598
        goto redo;
    } else {
599
        if ((acb->cluster_offset & 511) != 0) {
B
bellard 已提交
600 601 602
            ret = -EIO;
            goto fail;
        }
603
        acb->hd_aiocb = bdrv_aio_read(s->hd,
604
                            (acb->cluster_offset >> 9) + index_in_cluster,
605 606
                            acb->buf, acb->n, qcow_aio_read_cb, acb);
        if (acb->hd_aiocb == NULL)
B
bellard 已提交
607 608 609 610
            goto fail;
    }
}

611 612 613
static BlockDriverAIOCB *qcow_aio_read(BlockDriverState *bs,
        int64_t sector_num, uint8_t *buf, int nb_sectors,
        BlockDriverCompletionFunc *cb, void *opaque)
B
bellard 已提交
614
{
615 616 617 618 619 620 621 622 623 624
    QCowAIOCB *acb;

    acb = qemu_aio_get(bs, cb, opaque);
    if (!acb)
        return NULL;
    acb->hd_aiocb = NULL;
    acb->sector_num = sector_num;
    acb->buf = buf;
    acb->nb_sectors = nb_sectors;
    acb->n = 0;
625
    acb->cluster_offset = 0;
B
bellard 已提交
626 627

    qcow_aio_read_cb(acb, 0);
628
    return &acb->common;
B
bellard 已提交
629 630 631 632
}

static void qcow_aio_write_cb(void *opaque, int ret)
{
633 634
    QCowAIOCB *acb = opaque;
    BlockDriverState *bs = acb->common.bs;
B
bellard 已提交
635 636 637 638
    BDRVQcowState *s = bs->opaque;
    int index_in_cluster;
    uint64_t cluster_offset;
    const uint8_t *src_buf;
639 640 641

    acb->hd_aiocb = NULL;

B
bellard 已提交
642 643
    if (ret < 0) {
    fail:
644 645
        acb->common.cb(acb->common.opaque, ret);
        qemu_aio_release(acb);
B
bellard 已提交
646 647 648
        return;
    }

649 650 651
    acb->nb_sectors -= acb->n;
    acb->sector_num += acb->n;
    acb->buf += acb->n * 512;
B
bellard 已提交
652

653
    if (acb->nb_sectors == 0) {
B
bellard 已提交
654
        /* request completed */
655 656
        acb->common.cb(acb->common.opaque, 0);
        qemu_aio_release(acb);
B
bellard 已提交
657 658
        return;
    }
659

660 661 662 663
    index_in_cluster = acb->sector_num & (s->cluster_sectors - 1);
    acb->n = s->cluster_sectors - index_in_cluster;
    if (acb->n > acb->nb_sectors)
        acb->n = acb->nb_sectors;
664 665
    cluster_offset = get_cluster_offset(bs, acb->sector_num << 9, 1, 0,
                                        index_in_cluster,
666
                                        index_in_cluster + acb->n);
B
bellard 已提交
667 668 669 670 671
    if (!cluster_offset || (cluster_offset & 511) != 0) {
        ret = -EIO;
        goto fail;
    }
    if (s->crypt_method) {
672 673 674
        if (!acb->cluster_data) {
            acb->cluster_data = qemu_mallocz(s->cluster_size);
            if (!acb->cluster_data) {
B
bellard 已提交
675 676 677 678
                ret = -ENOMEM;
                goto fail;
            }
        }
679
        encrypt_sectors(s, acb->sector_num, acb->cluster_data, acb->buf,
680 681
                        acb->n, 1, &s->aes_encrypt_key);
        src_buf = acb->cluster_data;
B
bellard 已提交
682
    } else {
683
        src_buf = acb->buf;
B
bellard 已提交
684
    }
685
    acb->hd_aiocb = bdrv_aio_write(s->hd,
686 687
                                   (cluster_offset >> 9) + index_in_cluster,
                                   src_buf, acb->n,
688 689
                                   qcow_aio_write_cb, acb);
    if (acb->hd_aiocb == NULL)
B
bellard 已提交
690 691 692
        goto fail;
}

693 694 695
static BlockDriverAIOCB *qcow_aio_write(BlockDriverState *bs,
        int64_t sector_num, const uint8_t *buf, int nb_sectors,
        BlockDriverCompletionFunc *cb, void *opaque)
B
bellard 已提交
696 697
{
    BDRVQcowState *s = bs->opaque;
698
    QCowAIOCB *acb;
699

B
bellard 已提交
700 701
    s->cluster_cache_offset = -1; /* disable compressed cache */

702 703 704 705 706 707 708 709
    acb = qemu_aio_get(bs, cb, opaque);
    if (!acb)
        return NULL;
    acb->hd_aiocb = NULL;
    acb->sector_num = sector_num;
    acb->buf = (uint8_t *)buf;
    acb->nb_sectors = nb_sectors;
    acb->n = 0;
710

B
bellard 已提交
711
    qcow_aio_write_cb(acb, 0);
712
    return &acb->common;
B
bellard 已提交
713 714
}

715
static void qcow_aio_cancel(BlockDriverAIOCB *blockacb)
B
bellard 已提交
716
{
717 718 719 720
    QCowAIOCB *acb = (QCowAIOCB *)blockacb;
    if (acb->hd_aiocb)
        bdrv_aio_cancel(acb->hd_aiocb);
    qemu_aio_release(acb);
B
bellard 已提交
721 722
}

B
bellard 已提交
723
static void qcow_close(BlockDriverState *bs)
B
bellard 已提交
724 725 726 727 728 729
{
    BDRVQcowState *s = bs->opaque;
    qemu_free(s->l1_table);
    qemu_free(s->l2_cache);
    qemu_free(s->cluster_cache);
    qemu_free(s->cluster_data);
B
bellard 已提交
730
    bdrv_delete(s->hd);
B
bellard 已提交
731 732 733 734 735 736 737 738 739
}

static int qcow_create(const char *filename, int64_t total_size,
                      const char *backing_file, int flags)
{
    int fd, header_size, backing_filename_len, l1_size, i, shift;
    QCowHeader header;
    uint64_t tmp;

B
bellard 已提交
740
    fd = open(filename, O_WRONLY | O_CREAT | O_TRUNC | O_BINARY, 0644);
B
bellard 已提交
741 742 743 744 745 746 747 748 749
    if (fd < 0)
        return -1;
    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 已提交
750 751 752 753 754 755 756 757 758
        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 已提交
759 760 761 762 763 764 765 766 767 768 769 770
        header.cluster_bits = 9; /* 512 byte cluster to avoid copying
                                    unmodifyed sectors */
        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);
771
    if (flags & BLOCK_FLAG_ENCRYPT) {
B
bellard 已提交
772 773 774 775
        header.crypt_method = cpu_to_be32(QCOW_CRYPT_AES);
    } else {
        header.crypt_method = cpu_to_be32(QCOW_CRYPT_NONE);
    }
776

B
bellard 已提交
777 778 779
    /* write all the data */
    write(fd, &header, sizeof(header));
    if (backing_file) {
B
bellard 已提交
780
        write(fd, backing_file, backing_filename_len);
B
bellard 已提交
781 782 783 784 785 786 787 788 789 790
    }
    lseek(fd, header_size, SEEK_SET);
    tmp = 0;
    for(i = 0;i < l1_size; i++) {
        write(fd, &tmp, sizeof(tmp));
    }
    close(fd);
    return 0;
}

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);
B
bellard 已提交
798
    if (bdrv_pwrite(s->hd, s->l1_table_offset, s->l1_table, l1_length) < 0)
799
	return -1;
B
bellard 已提交
800 801 802
    ret = bdrv_truncate(s->hd, s->l1_table_offset + l1_length);
    if (ret < 0)
        return ret;
803 804 805 806 807 808 809 810

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

B
bellard 已提交
822 823
    if (nb_sectors != s->cluster_sectors)
        return -EINVAL;
B
bellard 已提交
824 825 826 827 828 829 830 831

    out_buf = qemu_malloc(s->cluster_size + (s->cluster_size / 1000) + 128);
    if (!out_buf)
        return -1;

    /* best compression, small window, no zlib header */
    memset(&strm, 0, sizeof(strm));
    ret = deflateInit2(&strm, Z_DEFAULT_COMPRESSION,
832
                       Z_DEFLATED, -12,
B
bellard 已提交
833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857
                       9, Z_DEFAULT_STRATEGY);
    if (ret != 0) {
        qemu_free(out_buf);
        return -1;
    }

    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) {
        qemu_free(out_buf);
        deflateEnd(&strm);
        return -1;
    }
    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 */
        qcow_write(bs, sector_num, buf, s->cluster_sectors);
    } else {
858
        cluster_offset = get_cluster_offset(bs, sector_num << 9, 2,
B
bellard 已提交
859 860
                                            out_len, 0, 0);
        cluster_offset &= s->cluster_offset_mask;
B
bellard 已提交
861
        if (bdrv_pwrite(s->hd, cluster_offset, out_buf, out_len) != out_len) {
B
bellard 已提交
862 863 864 865
            qemu_free(out_buf);
            return -1;
        }
    }
866

B
bellard 已提交
867 868 869 870
    qemu_free(out_buf);
    return 0;
}

P
pbrook 已提交
871 872 873
static void qcow_flush(BlockDriverState *bs)
{
    BDRVQcowState *s = bs->opaque;
B
bellard 已提交
874
    bdrv_flush(s->hd);
P
pbrook 已提交
875 876
}

B
bellard 已提交
877 878 879 880 881 882 883
static int qcow_get_info(BlockDriverState *bs, BlockDriverInfo *bdi)
{
    BDRVQcowState *s = bs->opaque;
    bdi->cluster_size = s->cluster_size;
    return 0;
}

B
bellard 已提交
884 885 886 887 888
BlockDriver bdrv_qcow = {
    "qcow",
    sizeof(BDRVQcowState),
    qcow_probe,
    qcow_open,
B
bellard 已提交
889 890
    NULL,
    NULL,
B
bellard 已提交
891 892
    qcow_close,
    qcow_create,
P
pbrook 已提交
893
    qcow_flush,
B
bellard 已提交
894 895
    qcow_is_allocated,
    qcow_set_key,
B
bellard 已提交
896 897 898 899 900
    qcow_make_empty,

    .bdrv_aio_read = qcow_aio_read,
    .bdrv_aio_write = qcow_aio_write,
    .bdrv_aio_cancel = qcow_aio_cancel,
901
    .aiocb_size = sizeof(QCowAIOCB),
B
bellard 已提交
902 903
    .bdrv_write_compressed = qcow_write_compressed,
    .bdrv_get_info = qcow_get_info,
B
bellard 已提交
904
};