qcow2-cluster.c 26.5 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30
/*
 * Block driver for the QCOW version 2 format
 *
 * Copyright (c) 2004-2006 Fabrice Bellard
 *
 * 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.
 */

#include <zlib.h>

#include "qemu-common.h"
#include "block_int.h"
#include "block/qcow2.h"

31
int qcow2_grow_l1_table(BlockDriverState *bs, int min_size, bool exact_size)
32 33 34 35
{
    BDRVQcowState *s = bs->opaque;
    int new_l1_size, new_l1_size2, ret, i;
    uint64_t *new_l1_table;
36
    int64_t new_l1_table_offset;
37 38
    uint8_t data[12];

39
    if (min_size <= s->l1_size)
40
        return 0;
41 42 43 44 45 46 47 48 49 50 51 52

    if (exact_size) {
        new_l1_size = min_size;
    } else {
        /* Bump size up to reduce the number of times we have to grow */
        new_l1_size = s->l1_size;
        if (new_l1_size == 0) {
            new_l1_size = 1;
        }
        while (min_size > new_l1_size) {
            new_l1_size = (new_l1_size * 3 + 1) / 2;
        }
53
    }
54

55
#ifdef DEBUG_ALLOC2
56
    fprintf(stderr, "grow l1_table from %d to %d\n", s->l1_size, new_l1_size);
57 58 59
#endif

    new_l1_size2 = sizeof(uint64_t) * new_l1_size;
60
    new_l1_table = g_malloc0(align_offset(new_l1_size2, 512));
61 62 63
    memcpy(new_l1_table, s->l1_table, s->l1_size * sizeof(uint64_t));

    /* write new table (align to cluster) */
64
    BLKDBG_EVENT(bs->file, BLKDBG_L1_GROW_ALLOC_TABLE);
K
Kevin Wolf 已提交
65
    new_l1_table_offset = qcow2_alloc_clusters(bs, new_l1_size2);
66
    if (new_l1_table_offset < 0) {
67
        g_free(new_l1_table);
68 69
        return new_l1_table_offset;
    }
K
Kevin Wolf 已提交
70 71 72

    ret = qcow2_cache_flush(bs, s->refcount_block_cache);
    if (ret < 0) {
73
        goto fail;
K
Kevin Wolf 已提交
74
    }
75

76
    BLKDBG_EVENT(bs->file, BLKDBG_L1_GROW_WRITE_TABLE);
77 78
    for(i = 0; i < s->l1_size; i++)
        new_l1_table[i] = cpu_to_be64(new_l1_table[i]);
79 80
    ret = bdrv_pwrite_sync(bs->file, new_l1_table_offset, new_l1_table, new_l1_size2);
    if (ret < 0)
81 82 83 84 85
        goto fail;
    for(i = 0; i < s->l1_size; i++)
        new_l1_table[i] = be64_to_cpu(new_l1_table[i]);

    /* set new table */
86
    BLKDBG_EVENT(bs->file, BLKDBG_L1_GROW_ACTIVATE_TABLE);
87
    cpu_to_be32w((uint32_t*)data, new_l1_size);
A
Aurelien Jarno 已提交
88
    cpu_to_be64wu((uint64_t*)(data + 4), new_l1_table_offset);
89 90
    ret = bdrv_pwrite_sync(bs->file, offsetof(QCowHeader, l1_size), data,sizeof(data));
    if (ret < 0) {
91
        goto fail;
92
    }
93
    g_free(s->l1_table);
K
Kevin Wolf 已提交
94
    qcow2_free_clusters(bs, s->l1_table_offset, s->l1_size * sizeof(uint64_t));
95 96 97 98 99
    s->l1_table_offset = new_l1_table_offset;
    s->l1_table = new_l1_table;
    s->l1_size = new_l1_size;
    return 0;
 fail:
100
    g_free(new_l1_table);
101
    qcow2_free_clusters(bs, new_l1_table_offset, new_l1_size2);
102
    return ret;
103 104 105 106 107 108 109 110 111 112 113 114
}

/*
 * l2_load
 *
 * Loads a L2 table into memory. If the table is in the cache, the cache
 * is used; otherwise the L2 table is loaded from the image file.
 *
 * Returns a pointer to the L2 table on success, or NULL if the read from
 * the image file failed.
 */

115 116
static int l2_load(BlockDriverState *bs, uint64_t l2_offset,
    uint64_t **l2_table)
117 118
{
    BDRVQcowState *s = bs->opaque;
119
    int ret;
120

K
Kevin Wolf 已提交
121
    ret = qcow2_cache_get(bs, s->l2_table_cache, l2_offset, (void**) l2_table);
122

K
Kevin Wolf 已提交
123
    return ret;
124 125
}

K
Kevin Wolf 已提交
126 127 128 129 130
/*
 * Writes one sector of the L1 table to the disk (can't update single entries
 * and we really don't want bdrv_pread to perform a read-modify-write)
 */
#define L1_ENTRIES_PER_SECTOR (512 / 8)
131
static int write_l1_entry(BlockDriverState *bs, int l1_index)
K
Kevin Wolf 已提交
132
{
133
    BDRVQcowState *s = bs->opaque;
K
Kevin Wolf 已提交
134 135
    uint64_t buf[L1_ENTRIES_PER_SECTOR];
    int l1_start_index;
136
    int i, ret;
K
Kevin Wolf 已提交
137 138 139 140 141 142

    l1_start_index = l1_index & ~(L1_ENTRIES_PER_SECTOR - 1);
    for (i = 0; i < L1_ENTRIES_PER_SECTOR; i++) {
        buf[i] = cpu_to_be64(s->l1_table[l1_start_index + i]);
    }

143
    BLKDBG_EVENT(bs->file, BLKDBG_L1_UPDATE);
144
    ret = bdrv_pwrite_sync(bs->file, s->l1_table_offset + 8 * l1_start_index,
145 146 147
        buf, sizeof(buf));
    if (ret < 0) {
        return ret;
K
Kevin Wolf 已提交
148 149 150 151 152
    }

    return 0;
}

153 154 155 156 157 158 159 160 161 162
/*
 * l2_allocate
 *
 * Allocate a new l2 entry in the file. If l1_index points to an already
 * used entry in the L2 table (i.e. we are doing a copy on write for the L2
 * table) copy the contents of the old L2 table into the newly allocated one.
 * Otherwise the new table is initialized with zeros.
 *
 */

163
static int l2_allocate(BlockDriverState *bs, int l1_index, uint64_t **table)
164 165
{
    BDRVQcowState *s = bs->opaque;
K
Kevin Wolf 已提交
166
    uint64_t old_l2_offset;
K
Kevin Wolf 已提交
167 168
    uint64_t *l2_table;
    int64_t l2_offset;
169
    int ret;
170 171 172 173 174

    old_l2_offset = s->l1_table[l1_index];

    /* allocate a new l2 entry */

K
Kevin Wolf 已提交
175
    l2_offset = qcow2_alloc_clusters(bs, s->l2_size * sizeof(uint64_t));
176
    if (l2_offset < 0) {
177
        return l2_offset;
178
    }
K
Kevin Wolf 已提交
179 180 181 182 183

    ret = qcow2_cache_flush(bs, s->refcount_block_cache);
    if (ret < 0) {
        goto fail;
    }
184 185 186

    /* allocate a new entry in the l2 cache */

K
Kevin Wolf 已提交
187 188 189 190 191 192
    ret = qcow2_cache_get_empty(bs, s->l2_table_cache, l2_offset, (void**) table);
    if (ret < 0) {
        return ret;
    }

    l2_table = *table;
193 194 195 196 197

    if (old_l2_offset == 0) {
        /* if there was no old l2 table, clear the new table */
        memset(l2_table, 0, s->l2_size * sizeof(uint64_t));
    } else {
K
Kevin Wolf 已提交
198 199
        uint64_t* old_table;

200
        /* if there was an old l2 table, read it from the disk */
201
        BLKDBG_EVENT(bs->file, BLKDBG_L2_ALLOC_COW_READ);
K
Kevin Wolf 已提交
202 203 204 205 206 207 208 209 210
        ret = qcow2_cache_get(bs, s->l2_table_cache, old_l2_offset,
            (void**) &old_table);
        if (ret < 0) {
            goto fail;
        }

        memcpy(l2_table, old_table, s->cluster_size);

        ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &old_table);
211
        if (ret < 0) {
212
            goto fail;
213
        }
214
    }
K
Kevin Wolf 已提交
215

216
    /* write the l2 table to the file */
217
    BLKDBG_EVENT(bs->file, BLKDBG_L2_ALLOC_WRITE);
K
Kevin Wolf 已提交
218 219 220

    qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
    ret = qcow2_cache_flush(bs, s->l2_table_cache);
221
    if (ret < 0) {
222 223 224 225 226 227 228 229
        goto fail;
    }

    /* update the L1 entry */
    s->l1_table[l1_index] = l2_offset | QCOW_OFLAG_COPIED;
    ret = write_l1_entry(bs, l1_index);
    if (ret < 0) {
        goto fail;
230
    }
231

232 233
    *table = l2_table;
    return 0;
234 235

fail:
K
Kevin Wolf 已提交
236
    qcow2_cache_put(bs, s->l2_table_cache, (void**) table);
237
    s->l1_table[l1_index] = old_l2_offset;
238
    return ret;
239 240 241 242 243 244 245 246 247 248 249 250
}

static int count_contiguous_clusters(uint64_t nb_clusters, int cluster_size,
        uint64_t *l2_table, uint64_t start, uint64_t mask)
{
    int i;
    uint64_t offset = be64_to_cpu(l2_table[0]) & ~mask;

    if (!offset)
        return 0;

    for (i = start; i < start + nb_clusters; i++)
251
        if (offset + (uint64_t) i * cluster_size != (be64_to_cpu(l2_table[i]) & ~mask))
252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269
            break;

	return (i - start);
}

static int count_contiguous_free_clusters(uint64_t nb_clusters, uint64_t *l2_table)
{
    int i = 0;

    while(nb_clusters-- && l2_table[i] == 0)
        i++;

    return i;
}

/* The crypt function is compatible with the linux cryptoloop
   algorithm for < 4 GB images. NOTE: out_buf == in_buf is
   supported */
K
Kevin Wolf 已提交
270 271 272 273
void qcow2_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)
274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296
{
    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;
        AES_cbc_encrypt(in_buf, out_buf, 512, key,
                        ivec.b, enc);
        sector_num++;
        in_buf += 512;
        out_buf += 512;
    }
}

static int copy_sectors(BlockDriverState *bs, uint64_t start_sect,
                        uint64_t cluster_offset, int n_start, int n_end)
{
    BDRVQcowState *s = bs->opaque;
    int n, ret;
K
Kevin Wolf 已提交
297 298 299 300 301 302 303 304 305 306
    void *buf;

    /*
     * If this is the last cluster and it is only partially used, we must only
     * copy until the end of the image, or bdrv_check_request will fail for the
     * bdrv_read/write calls below.
     */
    if (start_sect + n_end > bs->total_sectors) {
        n_end = bs->total_sectors - start_sect;
    }
307 308

    n = n_end - n_start;
K
Kevin Wolf 已提交
309
    if (n <= 0) {
310
        return 0;
K
Kevin Wolf 已提交
311 312 313 314
    }

    buf = qemu_blockalign(bs, n * BDRV_SECTOR_SIZE);

315
    BLKDBG_EVENT(bs->file, BLKDBG_COW_READ);
K
Kevin Wolf 已提交
316 317 318 319 320
    ret = bdrv_read(bs, start_sect + n_start, buf, n);
    if (ret < 0) {
        goto out;
    }

321
    if (s->crypt_method) {
K
Kevin Wolf 已提交
322
        qcow2_encrypt_sectors(s, start_sect + n_start,
K
Kevin Wolf 已提交
323
                        buf, buf, n, 1,
324 325
                        &s->aes_encrypt_key);
    }
K
Kevin Wolf 已提交
326

327
    BLKDBG_EVENT(bs->file, BLKDBG_COW_WRITE);
K
Kevin Wolf 已提交
328 329 330 331 332 333 334 335 336
    ret = bdrv_write(bs->file, (cluster_offset >> 9) + n_start, buf, n);
    if (ret < 0) {
        goto out;
    }

    ret = 0;
out:
    qemu_vfree(buf);
    return ret;
337 338 339 340 341 342
}


/*
 * get_cluster_offset
 *
343 344
 * For a given offset of the disk image, find the cluster offset in
 * qcow2 file. The offset is stored in *cluster_offset.
345
 *
346
 * on entry, *num is the number of contiguous sectors we'd like to
347 348
 * access following offset.
 *
349
 * on exit, *num is the number of contiguous sectors we can read.
350
 *
351 352
 * Return 0, if the offset is found
 * Return -errno, otherwise.
353 354 355
 *
 */

356 357
int qcow2_get_cluster_offset(BlockDriverState *bs, uint64_t offset,
    int *num, uint64_t *cluster_offset)
358 359
{
    BDRVQcowState *s = bs->opaque;
360
    unsigned int l1_index, l2_index;
361
    uint64_t l2_offset, *l2_table;
362
    int l1_bits, c;
363 364
    unsigned int index_in_cluster, nb_clusters;
    uint64_t nb_available, nb_needed;
365
    int ret;
366 367 368 369 370 371 372 373 374 375

    index_in_cluster = (offset >> 9) & (s->cluster_sectors - 1);
    nb_needed = *num + index_in_cluster;

    l1_bits = s->l2_bits + s->cluster_bits;

    /* compute how many bytes there are between the offset and
     * the end of the l1 entry
     */

376
    nb_available = (1ULL << l1_bits) - (offset & ((1ULL << l1_bits) - 1));
377 378 379 380 381 382 383 384 385

    /* compute the number of available sectors */

    nb_available = (nb_available >> 9) + index_in_cluster;

    if (nb_needed > nb_available) {
        nb_needed = nb_available;
    }

386
    *cluster_offset = 0;
387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403

    /* seek the the l2 offset in the l1 table */

    l1_index = offset >> l1_bits;
    if (l1_index >= s->l1_size)
        goto out;

    l2_offset = s->l1_table[l1_index];

    /* seek the l2 table of the given l2 offset */

    if (!l2_offset)
        goto out;

    /* load the l2 table in memory */

    l2_offset &= ~QCOW_OFLAG_COPIED;
404 405 406
    ret = l2_load(bs, l2_offset, &l2_table);
    if (ret < 0) {
        return ret;
407
    }
408 409 410 411

    /* find the cluster offset for the given disk offset */

    l2_index = (offset >> s->cluster_bits) & (s->l2_size - 1);
412
    *cluster_offset = be64_to_cpu(l2_table[l2_index]);
413 414
    nb_clusters = size_to_clusters(s, nb_needed << 9);

415
    if (!*cluster_offset) {
416 417 418 419 420 421 422 423
        /* how many empty clusters ? */
        c = count_contiguous_free_clusters(nb_clusters, &l2_table[l2_index]);
    } else {
        /* how many allocated clusters ? */
        c = count_contiguous_clusters(nb_clusters, s->cluster_size,
                &l2_table[l2_index], 0, QCOW_OFLAG_COPIED);
    }

K
Kevin Wolf 已提交
424 425
    qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);

426 427 428 429 430 431 432
   nb_available = (c * s->cluster_sectors);
out:
    if (nb_available > nb_needed)
        nb_available = nb_needed;

    *num = nb_available - index_in_cluster;

433 434
    *cluster_offset &=~QCOW_OFLAG_COPIED;
    return 0;
435 436 437 438 439 440 441 442 443 444 445
}

/*
 * get_cluster_table
 *
 * for a given disk offset, load (and allocate if needed)
 * the l2 table.
 *
 * the l2 table offset in the qcow2 file and the cluster index
 * in the l2 table are given to the caller.
 *
446
 * Returns 0 on success, -errno in failure case
447 448 449 450 451 452 453
 */
static int get_cluster_table(BlockDriverState *bs, uint64_t offset,
                             uint64_t **new_l2_table,
                             uint64_t *new_l2_offset,
                             int *new_l2_index)
{
    BDRVQcowState *s = bs->opaque;
454
    unsigned int l1_index, l2_index;
455 456
    uint64_t l2_offset;
    uint64_t *l2_table = NULL;
457
    int ret;
458 459 460 461 462

    /* seek the the l2 offset in the l1 table */

    l1_index = offset >> (s->l2_bits + s->cluster_bits);
    if (l1_index >= s->l1_size) {
463
        ret = qcow2_grow_l1_table(bs, l1_index + 1, false);
464 465 466
        if (ret < 0) {
            return ret;
        }
467 468 469 470 471 472 473 474
    }
    l2_offset = s->l1_table[l1_index];

    /* seek the l2 table of the given l2 offset */

    if (l2_offset & QCOW_OFLAG_COPIED) {
        /* load the l2 table in memory */
        l2_offset &= ~QCOW_OFLAG_COPIED;
475 476 477
        ret = l2_load(bs, l2_offset, &l2_table);
        if (ret < 0) {
            return ret;
478
        }
479
    } else {
K
Kevin Wolf 已提交
480
        /* First allocate a new L2 table (and do COW if needed) */
481 482 483
        ret = l2_allocate(bs, l1_index, &l2_table);
        if (ret < 0) {
            return ret;
484
        }
K
Kevin Wolf 已提交
485 486 487 488 489

        /* Then decrease the refcount of the old table */
        if (l2_offset) {
            qcow2_free_clusters(bs, l2_offset, s->l2_size * sizeof(uint64_t));
        }
490 491 492 493 494 495 496 497 498 499 500
        l2_offset = s->l1_table[l1_index] & ~QCOW_OFLAG_COPIED;
    }

    /* find the cluster offset for the given disk offset */

    l2_index = (offset >> s->cluster_bits) & (s->l2_size - 1);

    *new_l2_table = l2_table;
    *new_l2_offset = l2_offset;
    *new_l2_index = l2_index;

501
    return 0;
502 503 504 505 506 507 508 509 510 511 512 513 514 515 516
}

/*
 * alloc_compressed_cluster_offset
 *
 * For a given offset of the disk image, return cluster offset in
 * qcow2 file.
 *
 * If the offset is not found, allocate a new compressed cluster.
 *
 * Return the cluster offset if successful,
 * Return 0, otherwise.
 *
 */

K
Kevin Wolf 已提交
517 518 519
uint64_t qcow2_alloc_compressed_cluster_offset(BlockDriverState *bs,
                                               uint64_t offset,
                                               int compressed_size)
520 521 522
{
    BDRVQcowState *s = bs->opaque;
    int l2_index, ret;
K
Kevin Wolf 已提交
523 524
    uint64_t l2_offset, *l2_table;
    int64_t cluster_offset;
525 526 527
    int nb_csectors;

    ret = get_cluster_table(bs, offset, &l2_table, &l2_offset, &l2_index);
528
    if (ret < 0) {
529
        return 0;
530
    }
531 532

    cluster_offset = be64_to_cpu(l2_table[l2_index]);
533 534 535 536
    if (cluster_offset & QCOW_OFLAG_COPIED) {
        qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
        return 0;
    }
537 538

    if (cluster_offset)
K
Kevin Wolf 已提交
539
        qcow2_free_any_clusters(bs, cluster_offset, 1);
540

K
Kevin Wolf 已提交
541
    cluster_offset = qcow2_alloc_bytes(bs, compressed_size);
542
    if (cluster_offset < 0) {
K
Kevin Wolf 已提交
543
        qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
544 545 546
        return 0;
    }

547 548 549 550 551 552 553 554 555 556
    nb_csectors = ((cluster_offset + compressed_size - 1) >> 9) -
                  (cluster_offset >> 9);

    cluster_offset |= QCOW_OFLAG_COMPRESSED |
                      ((uint64_t)nb_csectors << s->csize_shift);

    /* update L2 table */

    /* compressed clusters never have the copied flag */

557
    BLKDBG_EVENT(bs->file, BLKDBG_L2_UPDATE_COMPRESSED);
K
Kevin Wolf 已提交
558
    qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
559
    l2_table[l2_index] = cpu_to_be64(cluster_offset);
K
Kevin Wolf 已提交
560
    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
561
    if (ret < 0) {
K
Kevin Wolf 已提交
562
        return 0;
563 564
    }

K
Kevin Wolf 已提交
565
    return cluster_offset;
566 567
}

568
int qcow2_alloc_cluster_link_l2(BlockDriverState *bs, QCowL2Meta *m)
569 570 571 572
{
    BDRVQcowState *s = bs->opaque;
    int i, j = 0, l2_index, ret;
    uint64_t *old_cluster, start_sect, l2_offset, *l2_table;
573
    uint64_t cluster_offset = m->cluster_offset;
K
Kevin Wolf 已提交
574
    bool cow = false;
575 576 577 578

    if (m->nb_clusters == 0)
        return 0;

579
    old_cluster = g_malloc(m->nb_clusters * sizeof(uint64_t));
580 581 582 583

    /* copy content of unmodified sectors */
    start_sect = (m->offset & ~(s->cluster_size - 1)) >> 9;
    if (m->n_start) {
K
Kevin Wolf 已提交
584
        cow = true;
K
Kevin Wolf 已提交
585
        qemu_co_mutex_unlock(&s->lock);
586
        ret = copy_sectors(bs, start_sect, cluster_offset, 0, m->n_start);
K
Kevin Wolf 已提交
587
        qemu_co_mutex_lock(&s->lock);
588 589 590 591 592 593
        if (ret < 0)
            goto err;
    }

    if (m->nb_available & (s->cluster_sectors - 1)) {
        uint64_t end = m->nb_available & ~(uint64_t)(s->cluster_sectors - 1);
K
Kevin Wolf 已提交
594
        cow = true;
K
Kevin Wolf 已提交
595
        qemu_co_mutex_unlock(&s->lock);
596 597
        ret = copy_sectors(bs, start_sect + end, cluster_offset + (end << 9),
                m->nb_available - end, s->cluster_sectors);
K
Kevin Wolf 已提交
598
        qemu_co_mutex_lock(&s->lock);
599 600 601 602
        if (ret < 0)
            goto err;
    }

K
Kevin Wolf 已提交
603 604 605 606 607 608 609 610
    /*
     * Update L2 table.
     *
     * Before we update the L2 table to actually point to the new cluster, we
     * need to be sure that the refcounts have been increased and COW was
     * handled.
     */
    if (cow) {
K
Kevin Wolf 已提交
611
        qcow2_cache_depends_on_flush(s->l2_table_cache);
K
Kevin Wolf 已提交
612 613 614
    }

    qcow2_cache_set_dependency(bs, s->l2_table_cache, s->refcount_block_cache);
615 616
    ret = get_cluster_table(bs, m->offset, &l2_table, &l2_offset, &l2_index);
    if (ret < 0) {
617
        goto err;
618
    }
K
Kevin Wolf 已提交
619
    qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
620 621 622 623 624 625 626 627 628 629 630 631 632 633 634

    for (i = 0; i < m->nb_clusters; i++) {
        /* if two concurrent writes happen to the same unallocated cluster
	 * each write allocates separate cluster and writes data concurrently.
	 * The first one to complete updates l2 table with pointer to its
	 * cluster the second one has to do RMW (which is done above by
	 * copy_sectors()), update l2 table with its cluster pointer and free
	 * old cluster. This is what this loop does */
        if(l2_table[l2_index + i] != 0)
            old_cluster[j++] = l2_table[l2_index + i];

        l2_table[l2_index + i] = cpu_to_be64((cluster_offset +
                    (i << s->cluster_bits)) | QCOW_OFLAG_COPIED);
     }

635

K
Kevin Wolf 已提交
636
    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
637
    if (ret < 0) {
638
        goto err;
639
    }
640

641 642 643 644 645 646 647 648 649 650
    /*
     * If this was a COW, we need to decrease the refcount of the old cluster.
     * Also flush bs->file to get the right order for L2 and refcount update.
     */
    if (j != 0) {
        for (i = 0; i < j; i++) {
            qcow2_free_any_clusters(bs,
                be64_to_cpu(old_cluster[i]) & ~QCOW_OFLAG_COPIED, 1);
        }
    }
651 652 653

    ret = 0;
err:
654
    g_free(old_cluster);
655 656 657 658 659 660
    return ret;
 }

/*
 * alloc_cluster_offset
 *
661
 * For a given offset of the disk image, return cluster offset in qcow2 file.
662 663
 * If the offset is not found, allocate a new cluster.
 *
664
 * If the cluster was already allocated, m->nb_clusters is set to 0,
665
 * other fields in m are meaningless.
666 667
 *
 * If the cluster is newly allocated, m->nb_clusters is set to the number of
K
Kevin Wolf 已提交
668 669 670
 * contiguous clusters that have been allocated. In this case, the other
 * fields of m are valid and contain information about the first allocated
 * cluster.
671
 *
K
Kevin Wolf 已提交
672 673
 * If the request conflicts with another write request in flight, the coroutine
 * is queued and will be reentered when the dependency has completed.
674 675
 *
 * Return 0 on success and -errno in error cases
676
 */
K
Kevin Wolf 已提交
677 678
int qcow2_alloc_cluster_offset(BlockDriverState *bs, uint64_t offset,
    int n_start, int n_end, int *num, QCowL2Meta *m)
679 680 681
{
    BDRVQcowState *s = bs->opaque;
    int l2_index, ret;
682 683
    uint64_t l2_offset, *l2_table;
    int64_t cluster_offset;
684
    unsigned int nb_clusters, i = 0;
685
    QCowL2Meta *old_alloc;
686 687

    ret = get_cluster_table(bs, offset, &l2_table, &l2_offset, &l2_index);
688
    if (ret < 0) {
689
        return ret;
690
    }
691

K
Kevin Wolf 已提交
692
again:
693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720
    nb_clusters = size_to_clusters(s, n_end << 9);

    nb_clusters = MIN(nb_clusters, s->l2_size - l2_index);

    cluster_offset = be64_to_cpu(l2_table[l2_index]);

    /* We keep all QCOW_OFLAG_COPIED clusters */

    if (cluster_offset & QCOW_OFLAG_COPIED) {
        nb_clusters = count_contiguous_clusters(nb_clusters, s->cluster_size,
                &l2_table[l2_index], 0, 0);

        cluster_offset &= ~QCOW_OFLAG_COPIED;
        m->nb_clusters = 0;

        goto out;
    }

    /* for the moment, multiple compressed clusters are not managed */

    if (cluster_offset & QCOW_OFLAG_COMPRESSED)
        nb_clusters = 1;

    /* how many available clusters ? */

    while (i < nb_clusters) {
        i += count_contiguous_clusters(nb_clusters - i, s->cluster_size,
                &l2_table[l2_index], i, 0);
721
        if ((i >= nb_clusters) || be64_to_cpu(l2_table[l2_index + i])) {
722
            break;
723
        }
724 725 726

        i += count_contiguous_free_clusters(nb_clusters - i,
                &l2_table[l2_index + i]);
727 728 729
        if (i >= nb_clusters) {
            break;
        }
730 731 732 733 734 735 736

        cluster_offset = be64_to_cpu(l2_table[l2_index + i]);

        if ((cluster_offset & QCOW_OFLAG_COPIED) ||
                (cluster_offset & QCOW_OFLAG_COMPRESSED))
            break;
    }
737
    assert(i <= nb_clusters);
738 739
    nb_clusters = i;

740 741 742 743 744
    /*
     * Check if there already is an AIO write request in flight which allocates
     * the same cluster. In this case we need to wait until the previous
     * request has completed and updated the L2 table accordingly.
     */
B
Blue Swirl 已提交
745
    QLIST_FOREACH(old_alloc, &s->cluster_allocs, next_in_flight) {
746

F
Frediano Ziglio 已提交
747 748 749 750
        uint64_t start = offset >> s->cluster_bits;
        uint64_t end = start + nb_clusters;
        uint64_t old_start = old_alloc->offset >> s->cluster_bits;
        uint64_t old_end = old_start + old_alloc->nb_clusters;
751

F
Frediano Ziglio 已提交
752
        if (end < old_start || start > old_end) {
753 754
            /* No intersection */
        } else {
F
Frediano Ziglio 已提交
755
            if (start < old_start) {
756
                /* Stop at the start of a running allocation */
F
Frediano Ziglio 已提交
757
                nb_clusters = old_start - start;
758 759 760 761 762
            } else {
                nb_clusters = 0;
            }

            if (nb_clusters == 0) {
K
Kevin Wolf 已提交
763 764 765 766 767 768
                /* Wait for the dependency to complete. We need to recheck
                 * the free/allocated clusters when we continue. */
                qemu_co_mutex_unlock(&s->lock);
                qemu_co_queue_wait(&old_alloc->dependent_requests);
                qemu_co_mutex_lock(&s->lock);
                goto again;
769 770 771 772 773 774 775 776
            }
        }
    }

    if (!nb_clusters) {
        abort();
    }

777 778 779 780 781
    /* save info needed for meta data update */
    m->offset = offset;
    m->n_start = n_start;
    m->nb_clusters = nb_clusters;

B
Blue Swirl 已提交
782
    QLIST_INSERT_HEAD(&s->cluster_allocs, m, next_in_flight);
783

784 785
    /* allocate a new cluster */

K
Kevin Wolf 已提交
786
    cluster_offset = qcow2_alloc_clusters(bs, nb_clusters * s->cluster_size);
787
    if (cluster_offset < 0) {
K
Kevin Wolf 已提交
788 789
        ret = cluster_offset;
        goto fail;
790
    }
791 792

out:
K
Kevin Wolf 已提交
793 794
    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
    if (ret < 0) {
795
        goto fail_put;
K
Kevin Wolf 已提交
796 797
    }

798
    m->nb_available = MIN(nb_clusters << (s->cluster_bits - 9), n_end);
799
    m->cluster_offset = cluster_offset;
800 801 802

    *num = m->nb_available - n_start;

803
    return 0;
K
Kevin Wolf 已提交
804 805 806

fail:
    qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
807 808
fail_put:
    QLIST_REMOVE(m, next_in_flight);
K
Kevin Wolf 已提交
809
    return ret;
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
}

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

839
int qcow2_decompress_cluster(BlockDriverState *bs, uint64_t cluster_offset)
840
{
841
    BDRVQcowState *s = bs->opaque;
842 843 844 845 846 847 848 849
    int ret, csize, nb_csectors, sector_offset;
    uint64_t coffset;

    coffset = cluster_offset & s->cluster_offset_mask;
    if (s->cluster_cache_offset != coffset) {
        nb_csectors = ((cluster_offset >> s->csize_shift) & s->csize_mask) + 1;
        sector_offset = coffset & 511;
        csize = nb_csectors * 512 - sector_offset;
850 851
        BLKDBG_EVENT(bs->file, BLKDBG_READ_COMPRESSED);
        ret = bdrv_read(bs->file, coffset >> 9, s->cluster_data, nb_csectors);
852
        if (ret < 0) {
853
            return ret;
854 855 856
        }
        if (decompress_buffer(s->cluster_cache, s->cluster_size,
                              s->cluster_data + sector_offset, csize) < 0) {
857
            return -EIO;
858 859 860 861 862
        }
        s->cluster_cache_offset = coffset;
    }
    return 0;
}
K
Kevin Wolf 已提交
863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944

/*
 * This discards as many clusters of nb_clusters as possible at once (i.e.
 * all clusters in the same L2 table) and returns the number of discarded
 * clusters.
 */
static int discard_single_l2(BlockDriverState *bs, uint64_t offset,
    unsigned int nb_clusters)
{
    BDRVQcowState *s = bs->opaque;
    uint64_t l2_offset, *l2_table;
    int l2_index;
    int ret;
    int i;

    ret = get_cluster_table(bs, offset, &l2_table, &l2_offset, &l2_index);
    if (ret < 0) {
        return ret;
    }

    /* Limit nb_clusters to one L2 table */
    nb_clusters = MIN(nb_clusters, s->l2_size - l2_index);

    for (i = 0; i < nb_clusters; i++) {
        uint64_t old_offset;

        old_offset = be64_to_cpu(l2_table[l2_index + i]);
        old_offset &= ~QCOW_OFLAG_COPIED;

        if (old_offset == 0) {
            continue;
        }

        /* First remove L2 entries */
        qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
        l2_table[l2_index + i] = cpu_to_be64(0);

        /* Then decrease the refcount */
        qcow2_free_any_clusters(bs, old_offset, 1);
    }

    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
    if (ret < 0) {
        return ret;
    }

    return nb_clusters;
}

int qcow2_discard_clusters(BlockDriverState *bs, uint64_t offset,
    int nb_sectors)
{
    BDRVQcowState *s = bs->opaque;
    uint64_t end_offset;
    unsigned int nb_clusters;
    int ret;

    end_offset = offset + (nb_sectors << BDRV_SECTOR_BITS);

    /* Round start up and end down */
    offset = align_offset(offset, s->cluster_size);
    end_offset &= ~(s->cluster_size - 1);

    if (offset > end_offset) {
        return 0;
    }

    nb_clusters = size_to_clusters(s, end_offset - offset);

    /* Each L2 table is handled by its own loop iteration */
    while (nb_clusters > 0) {
        ret = discard_single_l2(bs, offset, nb_clusters);
        if (ret < 0) {
            return ret;
        }

        nb_clusters -= ret;
        offset += (ret * s->cluster_size);
    }

    return 0;
}