qcow2-cluster.c 53.8 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
/*
 * 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"
28
#include "block/block_int.h"
29
#include "block/qcow2.h"
K
Kevin Wolf 已提交
30
#include "trace.h"
31

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

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

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

57 58 59 60
    if (new_l1_size > INT_MAX) {
        return -EFBIG;
    }

61
#ifdef DEBUG_ALLOC2
62 63
    fprintf(stderr, "grow l1_table from %d to %" PRId64 "\n",
            s->l1_size, new_l1_size);
64 65 66
#endif

    new_l1_size2 = sizeof(uint64_t) * new_l1_size;
67
    new_l1_table = g_malloc0(align_offset(new_l1_size2, 512));
68 69 70
    memcpy(new_l1_table, s->l1_table, s->l1_size * sizeof(uint64_t));

    /* write new table (align to cluster) */
71
    BLKDBG_EVENT(bs->file, BLKDBG_L1_GROW_ALLOC_TABLE);
K
Kevin Wolf 已提交
72
    new_l1_table_offset = qcow2_alloc_clusters(bs, new_l1_size2);
73
    if (new_l1_table_offset < 0) {
74
        g_free(new_l1_table);
75 76
        return new_l1_table_offset;
    }
K
Kevin Wolf 已提交
77 78 79

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

83 84 85 86 87 88 89 90
    /* the L1 position has not yet been updated, so these clusters must
     * indeed be completely free */
    ret = qcow2_pre_write_overlap_check(bs, QCOW2_OL_DEFAULT,
                                        new_l1_table_offset, new_l1_size2);
    if (ret < 0) {
        goto fail;
    }

91
    BLKDBG_EVENT(bs->file, BLKDBG_L1_GROW_WRITE_TABLE);
92 93
    for(i = 0; i < s->l1_size; i++)
        new_l1_table[i] = cpu_to_be64(new_l1_table[i]);
94 95
    ret = bdrv_pwrite_sync(bs->file, new_l1_table_offset, new_l1_table, new_l1_size2);
    if (ret < 0)
96 97 98 99 100
        goto fail;
    for(i = 0; i < s->l1_size; i++)
        new_l1_table[i] = be64_to_cpu(new_l1_table[i]);

    /* set new table */
101
    BLKDBG_EVENT(bs->file, BLKDBG_L1_GROW_ACTIVATE_TABLE);
102
    cpu_to_be32w((uint32_t*)data, new_l1_size);
A
Aurelien Jarno 已提交
103
    cpu_to_be64wu((uint64_t*)(data + 4), new_l1_table_offset);
104 105
    ret = bdrv_pwrite_sync(bs->file, offsetof(QCowHeader, l1_size), data,sizeof(data));
    if (ret < 0) {
106
        goto fail;
107
    }
108
    g_free(s->l1_table);
109 110
    qcow2_free_clusters(bs, s->l1_table_offset, s->l1_size * sizeof(uint64_t),
                        QCOW2_DISCARD_OTHER);
111 112 113 114 115
    s->l1_table_offset = new_l1_table_offset;
    s->l1_table = new_l1_table;
    s->l1_size = new_l1_size;
    return 0;
 fail:
116
    g_free(new_l1_table);
117 118
    qcow2_free_clusters(bs, new_l1_table_offset, new_l1_size2,
                        QCOW2_DISCARD_OTHER);
119
    return ret;
120 121 122 123 124 125 126 127 128 129 130 131
}

/*
 * 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.
 */

132 133
static int l2_load(BlockDriverState *bs, uint64_t l2_offset,
    uint64_t **l2_table)
134 135
{
    BDRVQcowState *s = bs->opaque;
136
    int ret;
137

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

K
Kevin Wolf 已提交
140
    return ret;
141 142
}

K
Kevin Wolf 已提交
143 144 145 146 147
/*
 * 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)
148
int qcow2_write_l1_entry(BlockDriverState *bs, int l1_index)
K
Kevin Wolf 已提交
149
{
150
    BDRVQcowState *s = bs->opaque;
K
Kevin Wolf 已提交
151 152
    uint64_t buf[L1_ENTRIES_PER_SECTOR];
    int l1_start_index;
153
    int i, ret;
K
Kevin Wolf 已提交
154 155 156 157 158 159

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

160 161 162 163 164 165 166
    ret = qcow2_pre_write_overlap_check(bs,
            QCOW2_OL_DEFAULT & ~QCOW2_OL_ACTIVE_L1,
            s->l1_table_offset + 8 * l1_start_index, sizeof(buf));
    if (ret < 0) {
        return ret;
    }

167
    BLKDBG_EVENT(bs->file, BLKDBG_L1_UPDATE);
168
    ret = bdrv_pwrite_sync(bs->file, s->l1_table_offset + 8 * l1_start_index,
169 170 171
        buf, sizeof(buf));
    if (ret < 0) {
        return ret;
K
Kevin Wolf 已提交
172 173 174 175 176
    }

    return 0;
}

177 178 179 180 181 182 183 184 185 186
/*
 * 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.
 *
 */

187
static int l2_allocate(BlockDriverState *bs, int l1_index, uint64_t **table)
188 189
{
    BDRVQcowState *s = bs->opaque;
K
Kevin Wolf 已提交
190
    uint64_t old_l2_offset;
K
Kevin Wolf 已提交
191 192
    uint64_t *l2_table;
    int64_t l2_offset;
193
    int ret;
194 195 196

    old_l2_offset = s->l1_table[l1_index];

K
Kevin Wolf 已提交
197 198
    trace_qcow2_l2_allocate(bs, l1_index);

199 200
    /* allocate a new l2 entry */

K
Kevin Wolf 已提交
201
    l2_offset = qcow2_alloc_clusters(bs, s->l2_size * sizeof(uint64_t));
202
    if (l2_offset < 0) {
203
        return l2_offset;
204
    }
K
Kevin Wolf 已提交
205 206 207 208 209

    ret = qcow2_cache_flush(bs, s->refcount_block_cache);
    if (ret < 0) {
        goto fail;
    }
210 211 212

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

K
Kevin Wolf 已提交
213
    trace_qcow2_l2_allocate_get_empty(bs, l1_index);
K
Kevin Wolf 已提交
214 215 216 217 218 219
    ret = qcow2_cache_get_empty(bs, s->l2_table_cache, l2_offset, (void**) table);
    if (ret < 0) {
        return ret;
    }

    l2_table = *table;
220

221
    if ((old_l2_offset & L1E_OFFSET_MASK) == 0) {
222 223 224
        /* 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 已提交
225 226
        uint64_t* old_table;

227
        /* if there was an old l2 table, read it from the disk */
228
        BLKDBG_EVENT(bs->file, BLKDBG_L2_ALLOC_COW_READ);
229 230
        ret = qcow2_cache_get(bs, s->l2_table_cache,
            old_l2_offset & L1E_OFFSET_MASK,
K
Kevin Wolf 已提交
231 232 233 234 235 236 237 238
            (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);
239
        if (ret < 0) {
240
            goto fail;
241
        }
242
    }
K
Kevin Wolf 已提交
243

244
    /* write the l2 table to the file */
245
    BLKDBG_EVENT(bs->file, BLKDBG_L2_ALLOC_WRITE);
K
Kevin Wolf 已提交
246

K
Kevin Wolf 已提交
247
    trace_qcow2_l2_allocate_write_l2(bs, l1_index);
K
Kevin Wolf 已提交
248 249
    qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
    ret = qcow2_cache_flush(bs, s->l2_table_cache);
250
    if (ret < 0) {
251 252 253 254
        goto fail;
    }

    /* update the L1 entry */
K
Kevin Wolf 已提交
255
    trace_qcow2_l2_allocate_write_l1(bs, l1_index);
256
    s->l1_table[l1_index] = l2_offset | QCOW_OFLAG_COPIED;
257
    ret = qcow2_write_l1_entry(bs, l1_index);
258 259
    if (ret < 0) {
        goto fail;
260
    }
261

262
    *table = l2_table;
K
Kevin Wolf 已提交
263
    trace_qcow2_l2_allocate_done(bs, l1_index, 0);
264
    return 0;
265 266

fail:
K
Kevin Wolf 已提交
267
    trace_qcow2_l2_allocate_done(bs, l1_index, ret);
K
Kevin Wolf 已提交
268
    qcow2_cache_put(bs, s->l2_table_cache, (void**) table);
269
    s->l1_table[l1_index] = old_l2_offset;
270
    return ret;
271 272
}

273 274 275 276 277 278 279
/*
 * Checks how many clusters in a given L2 table are contiguous in the image
 * file. As soon as one of the flags in the bitmask stop_flags changes compared
 * to the first cluster, the search is stopped and the cluster is not counted
 * as contiguous. (This allows it, for example, to stop at the first compressed
 * cluster which may require a different handling)
 */
280
static int count_contiguous_clusters(uint64_t nb_clusters, int cluster_size,
281
        uint64_t *l2_table, uint64_t start, uint64_t stop_flags)
282 283
{
    int i;
284 285
    uint64_t mask = stop_flags | L2E_OFFSET_MASK;
    uint64_t offset = be64_to_cpu(l2_table[0]) & mask;
286 287 288 289

    if (!offset)
        return 0;

290 291 292
    for (i = start; i < start + nb_clusters; i++) {
        uint64_t l2_entry = be64_to_cpu(l2_table[i]) & mask;
        if (offset + (uint64_t) i * cluster_size != l2_entry) {
293
            break;
294 295
        }
    }
296 297 298 299 300 301

	return (i - start);
}

static int count_contiguous_free_clusters(uint64_t nb_clusters, uint64_t *l2_table)
{
302 303 304 305
    int i;

    for (i = 0; i < nb_clusters; i++) {
        int type = qcow2_get_cluster_type(be64_to_cpu(l2_table[i]));
306

307 308 309 310
        if (type != QCOW2_CLUSTER_UNALLOCATED) {
            break;
        }
    }
311 312 313 314 315 316 317

    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 已提交
318 319 320 321
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)
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
{
    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;
    }
}

340 341 342 343
static int coroutine_fn copy_sectors(BlockDriverState *bs,
                                     uint64_t start_sect,
                                     uint64_t cluster_offset,
                                     int n_start, int n_end)
344 345
{
    BDRVQcowState *s = bs->opaque;
346 347
    QEMUIOVector qiov;
    struct iovec iov;
348
    int n, ret;
K
Kevin Wolf 已提交
349 350 351 352 353 354 355 356 357

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

    n = n_end - n_start;
K
Kevin Wolf 已提交
360
    if (n <= 0) {
361
        return 0;
K
Kevin Wolf 已提交
362 363
    }

364 365 366 367
    iov.iov_len = n * BDRV_SECTOR_SIZE;
    iov.iov_base = qemu_blockalign(bs, iov.iov_len);

    qemu_iovec_init_external(&qiov, &iov, 1);
K
Kevin Wolf 已提交
368

369
    BLKDBG_EVENT(bs->file, BLKDBG_COW_READ);
370 371 372 373 374 375

    /* Call .bdrv_co_readv() directly instead of using the public block-layer
     * interface.  This avoids double I/O throttling and request tracking,
     * which can lead to deadlock when block layer copy-on-read is enabled.
     */
    ret = bs->drv->bdrv_co_readv(bs, start_sect + n_start, n, &qiov);
K
Kevin Wolf 已提交
376 377 378 379
    if (ret < 0) {
        goto out;
    }

380
    if (s->crypt_method) {
K
Kevin Wolf 已提交
381
        qcow2_encrypt_sectors(s, start_sect + n_start,
382
                        iov.iov_base, iov.iov_base, n, 1,
383 384
                        &s->aes_encrypt_key);
    }
K
Kevin Wolf 已提交
385

386 387 388 389 390 391
    ret = qcow2_pre_write_overlap_check(bs, QCOW2_OL_DEFAULT,
            cluster_offset + n_start * BDRV_SECTOR_SIZE, n * BDRV_SECTOR_SIZE);
    if (ret < 0) {
        goto out;
    }

392
    BLKDBG_EVENT(bs->file, BLKDBG_COW_WRITE);
393
    ret = bdrv_co_writev(bs->file, (cluster_offset >> 9) + n_start, n, &qiov);
K
Kevin Wolf 已提交
394 395 396 397 398 399
    if (ret < 0) {
        goto out;
    }

    ret = 0;
out:
400
    qemu_vfree(iov.iov_base);
K
Kevin Wolf 已提交
401
    return ret;
402 403 404 405 406 407
}


/*
 * get_cluster_offset
 *
408 409
 * For a given offset of the disk image, find the cluster offset in
 * qcow2 file. The offset is stored in *cluster_offset.
410
 *
411
 * on entry, *num is the number of contiguous sectors we'd like to
412 413
 * access following offset.
 *
414
 * on exit, *num is the number of contiguous sectors we can read.
415
 *
416 417
 * Returns the cluster type (QCOW2_CLUSTER_*) on success, -errno in error
 * cases.
418
 */
419 420
int qcow2_get_cluster_offset(BlockDriverState *bs, uint64_t offset,
    int *num, uint64_t *cluster_offset)
421 422
{
    BDRVQcowState *s = bs->opaque;
423 424
    unsigned int l2_index;
    uint64_t l1_index, l2_offset, *l2_table;
425
    int l1_bits, c;
426 427
    unsigned int index_in_cluster, nb_clusters;
    uint64_t nb_available, nb_needed;
428
    int ret;
429 430 431 432 433 434 435 436 437 438

    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
     */

439
    nb_available = (1ULL << l1_bits) - (offset & ((1ULL << l1_bits) - 1));
440 441 442 443 444 445 446 447 448

    /* compute the number of available sectors */

    nb_available = (nb_available >> 9) + index_in_cluster;

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

449
    *cluster_offset = 0;
450 451 452 453

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

    l1_index = offset >> l1_bits;
454 455
    if (l1_index >= s->l1_size) {
        ret = QCOW2_CLUSTER_UNALLOCATED;
456
        goto out;
457
    }
458

459 460 461
    l2_offset = s->l1_table[l1_index] & L1E_OFFSET_MASK;
    if (!l2_offset) {
        ret = QCOW2_CLUSTER_UNALLOCATED;
462
        goto out;
463
    }
464 465 466

    /* load the l2 table in memory */

467 468 469
    ret = l2_load(bs, l2_offset, &l2_table);
    if (ret < 0) {
        return ret;
470
    }
471 472 473 474

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

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

478 479 480 481 482 483 484
    ret = qcow2_get_cluster_type(*cluster_offset);
    switch (ret) {
    case QCOW2_CLUSTER_COMPRESSED:
        /* Compressed clusters can only be processed one by one */
        c = 1;
        *cluster_offset &= L2E_COMPRESSED_OFFSET_SIZE_MASK;
        break;
485
    case QCOW2_CLUSTER_ZERO:
486 487 488
        if (s->qcow_version < 3) {
            return -EIO;
        }
489 490 491 492 493
        c = count_contiguous_clusters(nb_clusters, s->cluster_size,
                &l2_table[l2_index], 0,
                QCOW_OFLAG_COMPRESSED | QCOW_OFLAG_ZERO);
        *cluster_offset = 0;
        break;
494
    case QCOW2_CLUSTER_UNALLOCATED:
495 496
        /* how many empty clusters ? */
        c = count_contiguous_free_clusters(nb_clusters, &l2_table[l2_index]);
497 498 499
        *cluster_offset = 0;
        break;
    case QCOW2_CLUSTER_NORMAL:
500 501
        /* how many allocated clusters ? */
        c = count_contiguous_clusters(nb_clusters, s->cluster_size,
502 503
                &l2_table[l2_index], 0,
                QCOW_OFLAG_COMPRESSED | QCOW_OFLAG_ZERO);
504 505
        *cluster_offset &= L2E_OFFSET_MASK;
        break;
K
Kevin Wolf 已提交
506 507
    default:
        abort();
508 509
    }

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

512 513
    nb_available = (c * s->cluster_sectors);

514 515 516 517 518 519
out:
    if (nb_available > nb_needed)
        nb_available = nb_needed;

    *num = nb_available - index_in_cluster;

520
    return ret;
521 522 523 524 525 526 527 528 529 530 531
}

/*
 * 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.
 *
532
 * Returns 0 on success, -errno in failure case
533 534 535 536 537 538
 */
static int get_cluster_table(BlockDriverState *bs, uint64_t offset,
                             uint64_t **new_l2_table,
                             int *new_l2_index)
{
    BDRVQcowState *s = bs->opaque;
539 540
    unsigned int l2_index;
    uint64_t l1_index, l2_offset;
541
    uint64_t *l2_table = NULL;
542
    int ret;
543 544 545 546 547

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

    l1_index = offset >> (s->l2_bits + s->cluster_bits);
    if (l1_index >= s->l1_size) {
548
        ret = qcow2_grow_l1_table(bs, l1_index + 1, false);
549 550 551
        if (ret < 0) {
            return ret;
        }
552
    }
553

554
    assert(l1_index < s->l1_size);
555
    l2_offset = s->l1_table[l1_index] & L1E_OFFSET_MASK;
556 557 558

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

559
    if (s->l1_table[l1_index] & QCOW_OFLAG_COPIED) {
560
        /* load the l2 table in memory */
561 562 563
        ret = l2_load(bs, l2_offset, &l2_table);
        if (ret < 0) {
            return ret;
564
        }
565
    } else {
K
Kevin Wolf 已提交
566
        /* First allocate a new L2 table (and do COW if needed) */
567 568 569
        ret = l2_allocate(bs, l1_index, &l2_table);
        if (ret < 0) {
            return ret;
570
        }
K
Kevin Wolf 已提交
571 572 573

        /* Then decrease the refcount of the old table */
        if (l2_offset) {
574 575
            qcow2_free_clusters(bs, l2_offset, s->l2_size * sizeof(uint64_t),
                                QCOW2_DISCARD_OTHER);
K
Kevin Wolf 已提交
576
        }
577 578 579 580 581 582 583 584 585
    }

    /* 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_index = l2_index;

586
    return 0;
587 588 589 590 591 592 593 594 595 596 597 598 599 600 601
}

/*
 * 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 已提交
602 603 604
uint64_t qcow2_alloc_compressed_cluster_offset(BlockDriverState *bs,
                                               uint64_t offset,
                                               int compressed_size)
605 606 607
{
    BDRVQcowState *s = bs->opaque;
    int l2_index, ret;
608
    uint64_t *l2_table;
K
Kevin Wolf 已提交
609
    int64_t cluster_offset;
610 611
    int nb_csectors;

612
    ret = get_cluster_table(bs, offset, &l2_table, &l2_index);
613
    if (ret < 0) {
614
        return 0;
615
    }
616

617 618
    /* Compression can't overwrite anything. Fail if the cluster was already
     * allocated. */
619
    cluster_offset = be64_to_cpu(l2_table[l2_index]);
620
    if (cluster_offset & L2E_OFFSET_MASK) {
621 622 623
        qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
        return 0;
    }
624

K
Kevin Wolf 已提交
625
    cluster_offset = qcow2_alloc_bytes(bs, compressed_size);
626
    if (cluster_offset < 0) {
K
Kevin Wolf 已提交
627
        qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
628 629 630
        return 0;
    }

631 632 633 634 635 636 637 638 639 640
    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 */

641
    BLKDBG_EVENT(bs->file, BLKDBG_L2_UPDATE_COMPRESSED);
K
Kevin Wolf 已提交
642
    qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
643
    l2_table[l2_index] = cpu_to_be64(cluster_offset);
K
Kevin Wolf 已提交
644
    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
645
    if (ret < 0) {
K
Kevin Wolf 已提交
646
        return 0;
647 648
    }

K
Kevin Wolf 已提交
649
    return cluster_offset;
650 651
}

K
Kevin Wolf 已提交
652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680
static int perform_cow(BlockDriverState *bs, QCowL2Meta *m, Qcow2COWRegion *r)
{
    BDRVQcowState *s = bs->opaque;
    int ret;

    if (r->nb_sectors == 0) {
        return 0;
    }

    qemu_co_mutex_unlock(&s->lock);
    ret = copy_sectors(bs, m->offset / BDRV_SECTOR_SIZE, m->alloc_offset,
                       r->offset / BDRV_SECTOR_SIZE,
                       r->offset / BDRV_SECTOR_SIZE + r->nb_sectors);
    qemu_co_mutex_lock(&s->lock);

    if (ret < 0) {
        return ret;
    }

    /*
     * 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.
     */
    qcow2_cache_depends_on_flush(s->l2_table_cache);

    return 0;
}

681
int qcow2_alloc_cluster_link_l2(BlockDriverState *bs, QCowL2Meta *m)
682 683 684
{
    BDRVQcowState *s = bs->opaque;
    int i, j = 0, l2_index, ret;
K
Kevin Wolf 已提交
685
    uint64_t *old_cluster, *l2_table;
686
    uint64_t cluster_offset = m->alloc_offset;
687

K
Kevin Wolf 已提交
688
    trace_qcow2_cluster_link_l2(qemu_coroutine_self(), m->nb_clusters);
689
    assert(m->nb_clusters > 0);
690

691
    old_cluster = g_malloc(m->nb_clusters * sizeof(uint64_t));
692 693

    /* copy content of unmodified sectors */
K
Kevin Wolf 已提交
694 695 696
    ret = perform_cow(bs, m, &m->cow_start);
    if (ret < 0) {
        goto err;
697 698
    }

K
Kevin Wolf 已提交
699 700 701
    ret = perform_cow(bs, m, &m->cow_end);
    if (ret < 0) {
        goto err;
K
Kevin Wolf 已提交
702 703
    }

K
Kevin Wolf 已提交
704
    /* Update L2 table. */
705
    if (s->use_lazy_refcounts) {
706 707
        qcow2_mark_dirty(bs);
    }
708 709 710 711
    if (qcow2_need_accurate_refcounts(s)) {
        qcow2_cache_set_dependency(bs, s->l2_table_cache,
                                   s->refcount_block_cache);
    }
712

713
    ret = get_cluster_table(bs, m->offset, &l2_table, &l2_index);
714
    if (ret < 0) {
715
        goto err;
716
    }
K
Kevin Wolf 已提交
717
    qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
718

719
    assert(l2_index + m->nb_clusters <= s->l2_size);
720 721 722 723 724 725 726 727 728 729 730 731 732 733
    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);
     }

734

K
Kevin Wolf 已提交
735
    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
736
    if (ret < 0) {
737
        goto err;
738
    }
739

740 741 742
    /*
     * 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.
743 744 745
     *
     * Don't discard clusters that reach a refcount of 0 (e.g. compressed
     * clusters), the next write will reuse them anyway.
746 747 748
     */
    if (j != 0) {
        for (i = 0; i < j; i++) {
749 750
            qcow2_free_any_clusters(bs, be64_to_cpu(old_cluster[i]), 1,
                                    QCOW2_DISCARD_NEVER);
751 752
        }
    }
753 754 755

    ret = 0;
err:
756
    g_free(old_cluster);
757 758 759
    return ret;
 }

760 761 762 763 764 765 766 767
/*
 * Returns the number of contiguous clusters that can be used for an allocating
 * write, but require COW to be performed (this includes yet unallocated space,
 * which must copy from the backing file)
 */
static int count_cow_clusters(BDRVQcowState *s, int nb_clusters,
    uint64_t *l2_table, int l2_index)
{
K
Kevin Wolf 已提交
768
    int i;
769

K
Kevin Wolf 已提交
770 771 772 773 774 775 776 777 778
    for (i = 0; i < nb_clusters; i++) {
        uint64_t l2_entry = be64_to_cpu(l2_table[l2_index + i]);
        int cluster_type = qcow2_get_cluster_type(l2_entry);

        switch(cluster_type) {
        case QCOW2_CLUSTER_NORMAL:
            if (l2_entry & QCOW_OFLAG_COPIED) {
                goto out;
            }
779
            break;
K
Kevin Wolf 已提交
780 781
        case QCOW2_CLUSTER_UNALLOCATED:
        case QCOW2_CLUSTER_COMPRESSED:
782
        case QCOW2_CLUSTER_ZERO:
783
            break;
K
Kevin Wolf 已提交
784 785 786
        default:
            abort();
        }
787 788
    }

K
Kevin Wolf 已提交
789
out:
790 791 792 793
    assert(i <= nb_clusters);
    return i;
}

794
/*
795 796 797
 * 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.
798 799 800 801 802 803 804 805 806
 *
 * Returns:
 *   0       if there was no dependency. *cur_bytes indicates the number of
 *           bytes from guest_offset that can be read before the next
 *           dependency must be processed (or the request is complete)
 *
 *   -EAGAIN if we had to wait for another request, previously gathered
 *           information on cluster allocation may be invalid now. The caller
 *           must start over anyway, so consider *cur_bytes undefined.
807
 */
808
static int handle_dependencies(BlockDriverState *bs, uint64_t guest_offset,
809
    uint64_t *cur_bytes, QCowL2Meta **m)
810 811 812
{
    BDRVQcowState *s = bs->opaque;
    QCowL2Meta *old_alloc;
813
    uint64_t bytes = *cur_bytes;
814 815 816

    QLIST_FOREACH(old_alloc, &s->cluster_allocs, next_in_flight) {

817 818 819 820
        uint64_t start = guest_offset;
        uint64_t end = start + bytes;
        uint64_t old_start = l2meta_cow_start(old_alloc);
        uint64_t old_end = l2meta_cow_end(old_alloc);
821

822
        if (end <= old_start || start >= old_end) {
823 824 825 826
            /* No intersection */
        } else {
            if (start < old_start) {
                /* Stop at the start of a running allocation */
827
                bytes = old_start - start;
828
            } else {
829
                bytes = 0;
830 831
            }

832 833 834 835 836 837 838 839 840
            /* Stop if already an l2meta exists. After yielding, it wouldn't
             * be valid any more, so we'd have to clean up the old L2Metas
             * and deal with requests depending on them before starting to
             * gather new ones. Not worth the trouble. */
            if (bytes == 0 && *m) {
                *cur_bytes = 0;
                return 0;
            }

841
            if (bytes == 0) {
842 843 844 845 846 847 848 849 850 851
                /* 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);
                return -EAGAIN;
            }
        }
    }

852 853 854
    /* Make sure that existing clusters and new allocations are only used up to
     * the next dependency if we shortened the request above */
    *cur_bytes = bytes;
855

856 857 858
    return 0;
}

K
Kevin Wolf 已提交
859 860 861 862 863 864
/*
 * Checks how many already allocated clusters that don't require a copy on
 * write there are at the given guest_offset (up to *bytes). If
 * *host_offset is not zero, only physically contiguous clusters beginning at
 * this host offset are counted.
 *
865 866 867
 * Note that guest_offset may not be cluster aligned. In this case, the
 * returned *host_offset points to exact byte referenced by guest_offset and
 * therefore isn't cluster aligned as well.
K
Kevin Wolf 已提交
868 869 870 871 872 873 874 875 876 877 878 879 880 881
 *
 * Returns:
 *   0:     if no allocated clusters are available at the given offset.
 *          *bytes is normally unchanged. It is set to 0 if the cluster
 *          is allocated and doesn't need COW, but doesn't have the right
 *          physical offset.
 *
 *   1:     if allocated clusters that don't require a COW are available at
 *          the requested offset. *bytes may have decreased and describes
 *          the length of the area that can be written to.
 *
 *  -errno: in error cases
 */
static int handle_copied(BlockDriverState *bs, uint64_t guest_offset,
882
    uint64_t *host_offset, uint64_t *bytes, QCowL2Meta **m)
K
Kevin Wolf 已提交
883 884 885 886 887
{
    BDRVQcowState *s = bs->opaque;
    int l2_index;
    uint64_t cluster_offset;
    uint64_t *l2_table;
888
    unsigned int nb_clusters;
889
    unsigned int keep_clusters;
K
Kevin Wolf 已提交
890 891 892 893 894
    int ret, pret;

    trace_qcow2_handle_copied(qemu_coroutine_self(), guest_offset, *host_offset,
                              *bytes);

895 896 897
    assert(*host_offset == 0 ||    offset_into_cluster(s, guest_offset)
                                == offset_into_cluster(s, *host_offset));

898 899 900 901 902 903 904 905 906 907
    /*
     * Calculate the number of clusters to look for. We stop at L2 table
     * boundaries to keep things simple.
     */
    nb_clusters =
        size_to_clusters(s, offset_into_cluster(s, guest_offset) + *bytes);

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

K
Kevin Wolf 已提交
908 909 910 911 912 913 914 915 916 917 918 919
    /* Find L2 entry for the first involved cluster */
    ret = get_cluster_table(bs, guest_offset, &l2_table, &l2_index);
    if (ret < 0) {
        return ret;
    }

    cluster_offset = be64_to_cpu(l2_table[l2_index]);

    /* Check how many clusters are already allocated and don't need COW */
    if (qcow2_get_cluster_type(cluster_offset) == QCOW2_CLUSTER_NORMAL
        && (cluster_offset & QCOW_OFLAG_COPIED))
    {
920 921 922 923 924 925 926 927 928 929
        /* If a specific host_offset is required, check it */
        bool offset_matches =
            (cluster_offset & L2E_OFFSET_MASK) == *host_offset;

        if (*host_offset != 0 && !offset_matches) {
            *bytes = 0;
            ret = 0;
            goto out;
        }

K
Kevin Wolf 已提交
930
        /* We keep all QCOW_OFLAG_COPIED clusters */
931
        keep_clusters =
932
            count_contiguous_clusters(nb_clusters, s->cluster_size,
K
Kevin Wolf 已提交
933 934
                                      &l2_table[l2_index], 0,
                                      QCOW_OFLAG_COPIED | QCOW_OFLAG_ZERO);
935 936 937 938 939
        assert(keep_clusters <= nb_clusters);

        *bytes = MIN(*bytes,
                 keep_clusters * s->cluster_size
                 - offset_into_cluster(s, guest_offset));
K
Kevin Wolf 已提交
940 941 942 943 944 945 946

        ret = 1;
    } else {
        ret = 0;
    }

    /* Cleanup */
947
out:
K
Kevin Wolf 已提交
948 949 950 951 952
    pret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
    if (pret < 0) {
        return pret;
    }

953 954 955
    /* Only return a host offset if we actually made progress. Otherwise we
     * would make requirements for handle_alloc() that it can't fulfill */
    if (ret) {
956 957
        *host_offset = (cluster_offset & L2E_OFFSET_MASK)
                     + offset_into_cluster(s, guest_offset);
958 959
    }

K
Kevin Wolf 已提交
960 961 962
    return ret;
}

963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989
/*
 * Allocates new clusters for the given guest_offset.
 *
 * At most *nb_clusters are allocated, and on return *nb_clusters is updated to
 * contain the number of clusters that have been allocated and are contiguous
 * in the image file.
 *
 * If *host_offset is non-zero, it specifies the offset in the image file at
 * which the new clusters must start. *nb_clusters can be 0 on return in this
 * case if the cluster at host_offset is already in use. If *host_offset is
 * zero, the clusters can be allocated anywhere in the image file.
 *
 * *host_offset is updated to contain the offset into the image file at which
 * the first allocated cluster starts.
 *
 * Return 0 on success and -errno in error cases. -EAGAIN means that the
 * function has been waiting for another request and the allocation must be
 * restarted, but the whole request should not be failed.
 */
static int do_alloc_cluster_offset(BlockDriverState *bs, uint64_t guest_offset,
    uint64_t *host_offset, unsigned int *nb_clusters)
{
    BDRVQcowState *s = bs->opaque;

    trace_qcow2_do_alloc_clusters_offset(qemu_coroutine_self(), guest_offset,
                                         *host_offset, *nb_clusters);

990 991 992
    /* Allocate new clusters */
    trace_qcow2_cluster_alloc_phys(qemu_coroutine_self());
    if (*host_offset == 0) {
993 994 995 996 997 998 999
        int64_t cluster_offset =
            qcow2_alloc_clusters(bs, *nb_clusters * s->cluster_size);
        if (cluster_offset < 0) {
            return cluster_offset;
        }
        *host_offset = cluster_offset;
        return 0;
1000
    } else {
K
Kevin Wolf 已提交
1001
        int ret = qcow2_alloc_clusters_at(bs, *host_offset, *nb_clusters);
1002 1003 1004 1005 1006
        if (ret < 0) {
            return ret;
        }
        *nb_clusters = ret;
        return 0;
1007 1008 1009
    }
}

K
Kevin Wolf 已提交
1010 1011 1012 1013 1014
/*
 * Allocates new clusters for an area that either is yet unallocated or needs a
 * copy on write. If *host_offset is non-zero, clusters are only allocated if
 * the new allocation can match the specified host offset.
 *
1015 1016 1017
 * Note that guest_offset may not be cluster aligned. In this case, the
 * returned *host_offset points to exact byte referenced by guest_offset and
 * therefore isn't cluster aligned as well.
K
Kevin Wolf 已提交
1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030
 *
 * Returns:
 *   0:     if no clusters could be allocated. *bytes is set to 0,
 *          *host_offset is left unchanged.
 *
 *   1:     if new clusters were allocated. *bytes may be decreased if the
 *          new allocation doesn't cover all of the requested area.
 *          *host_offset is updated to contain the host offset of the first
 *          newly allocated cluster.
 *
 *  -errno: in error cases
 */
static int handle_alloc(BlockDriverState *bs, uint64_t guest_offset,
1031
    uint64_t *host_offset, uint64_t *bytes, QCowL2Meta **m)
K
Kevin Wolf 已提交
1032 1033 1034 1035 1036
{
    BDRVQcowState *s = bs->opaque;
    int l2_index;
    uint64_t *l2_table;
    uint64_t entry;
1037
    unsigned int nb_clusters;
K
Kevin Wolf 已提交
1038 1039 1040 1041 1042 1043 1044 1045
    int ret;

    uint64_t alloc_cluster_offset;

    trace_qcow2_handle_alloc(qemu_coroutine_self(), guest_offset, *host_offset,
                             *bytes);
    assert(*bytes > 0);

1046 1047 1048 1049
    /*
     * Calculate the number of clusters to look for. We stop at L2 table
     * boundaries to keep things simple.
     */
1050 1051 1052
    nb_clusters =
        size_to_clusters(s, offset_into_cluster(s, guest_offset) + *bytes);

1053
    l2_index = offset_to_l2_index(s, guest_offset);
1054
    nb_clusters = MIN(nb_clusters, s->l2_size - l2_index);
1055

K
Kevin Wolf 已提交
1056 1057 1058 1059 1060 1061
    /* Find L2 entry for the first involved cluster */
    ret = get_cluster_table(bs, guest_offset, &l2_table, &l2_index);
    if (ret < 0) {
        return ret;
    }

1062
    entry = be64_to_cpu(l2_table[l2_index]);
K
Kevin Wolf 已提交
1063 1064 1065 1066 1067

    /* For the moment, overwrite compressed clusters one by one */
    if (entry & QCOW_OFLAG_COMPRESSED) {
        nb_clusters = 1;
    } else {
1068
        nb_clusters = count_cow_clusters(s, nb_clusters, l2_table, l2_index);
K
Kevin Wolf 已提交
1069 1070
    }

1071 1072 1073 1074 1075
    /* This function is only called when there were no non-COW clusters, so if
     * we can't find any unallocated or COW clusters either, something is
     * wrong with our code. */
    assert(nb_clusters > 0);

K
Kevin Wolf 已提交
1076 1077 1078 1079 1080 1081
    ret = qcow2_cache_put(bs, s->l2_table_cache, (void**) &l2_table);
    if (ret < 0) {
        return ret;
    }

    /* Allocate, if necessary at a given offset in the image file */
1082
    alloc_cluster_offset = start_of_cluster(s, *host_offset);
K
Kevin Wolf 已提交
1083
    ret = do_alloc_cluster_offset(bs, guest_offset, &alloc_cluster_offset,
K
Kevin Wolf 已提交
1084 1085 1086 1087 1088
                                  &nb_clusters);
    if (ret < 0) {
        goto fail;
    }

K
Kevin Wolf 已提交
1089 1090
    /* Can't extend contiguous allocation */
    if (nb_clusters == 0) {
K
Kevin Wolf 已提交
1091 1092 1093 1094
        *bytes = 0;
        return 0;
    }

K
Kevin Wolf 已提交
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116
    /*
     * Save info needed for meta data update.
     *
     * requested_sectors: Number of sectors from the start of the first
     * newly allocated cluster to the end of the (possibly shortened
     * before) write request.
     *
     * avail_sectors: Number of sectors from the start of the first
     * newly allocated to the end of the last newly allocated cluster.
     *
     * nb_sectors: The number of sectors from the start of the first
     * newly allocated cluster to the end of the area that the write
     * request actually writes to (excluding COW at the end)
     */
    int requested_sectors =
        (*bytes + offset_into_cluster(s, guest_offset))
        >> BDRV_SECTOR_BITS;
    int avail_sectors = nb_clusters
                        << (s->cluster_bits - BDRV_SECTOR_BITS);
    int alloc_n_start = offset_into_cluster(s, guest_offset)
                        >> BDRV_SECTOR_BITS;
    int nb_sectors = MIN(requested_sectors, avail_sectors);
1117
    QCowL2Meta *old_m = *m;
K
Kevin Wolf 已提交
1118 1119 1120 1121

    *m = g_malloc0(sizeof(**m));

    **m = (QCowL2Meta) {
1122 1123
        .next           = old_m,

1124
        .alloc_offset   = alloc_cluster_offset,
K
Kevin Wolf 已提交
1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140
        .offset         = start_of_cluster(s, guest_offset),
        .nb_clusters    = nb_clusters,
        .nb_available   = nb_sectors,

        .cow_start = {
            .offset     = 0,
            .nb_sectors = alloc_n_start,
        },
        .cow_end = {
            .offset     = nb_sectors * BDRV_SECTOR_SIZE,
            .nb_sectors = avail_sectors - nb_sectors,
        },
    };
    qemu_co_queue_init(&(*m)->dependent_requests);
    QLIST_INSERT_HEAD(&s->cluster_allocs, *m, next_in_flight);

1141
    *host_offset = alloc_cluster_offset + offset_into_cluster(s, guest_offset);
K
Kevin Wolf 已提交
1142 1143 1144 1145
    *bytes = MIN(*bytes, (nb_sectors * BDRV_SECTOR_SIZE)
                         - offset_into_cluster(s, guest_offset));
    assert(*bytes != 0);

K
Kevin Wolf 已提交
1146 1147 1148 1149 1150 1151 1152 1153 1154
    return 1;

fail:
    if (*m && (*m)->nb_clusters > 0) {
        QLIST_REMOVE(*m, next_in_flight);
    }
    return ret;
}

1155 1156 1157
/*
 * alloc_cluster_offset
 *
1158 1159
 * For a given offset on the virtual disk, find the cluster offset in qcow2
 * file. If the offset is not found, allocate a new cluster.
1160
 *
1161
 * If the cluster was already allocated, m->nb_clusters is set to 0 and
1162
 * other fields in m are meaningless.
1163 1164
 *
 * If the cluster is newly allocated, m->nb_clusters is set to the number of
K
Kevin Wolf 已提交
1165 1166 1167
 * contiguous clusters that have been allocated. In this case, the other
 * fields of m are valid and contain information about the first allocated
 * cluster.
1168
 *
K
Kevin Wolf 已提交
1169 1170
 * If the request conflicts with another write request in flight, the coroutine
 * is queued and will be reentered when the dependency has completed.
1171 1172
 *
 * Return 0 on success and -errno in error cases
1173
 */
K
Kevin Wolf 已提交
1174
int qcow2_alloc_cluster_offset(BlockDriverState *bs, uint64_t offset,
1175
    int n_start, int n_end, int *num, uint64_t *host_offset, QCowL2Meta **m)
1176 1177
{
    BDRVQcowState *s = bs->opaque;
1178
    uint64_t start, remaining;
1179
    uint64_t cluster_offset;
1180
    uint64_t cur_bytes;
1181
    int ret;
1182

K
Kevin Wolf 已提交
1183 1184 1185
    trace_qcow2_alloc_clusters_offset(qemu_coroutine_self(), offset,
                                      n_start, n_end);

1186 1187 1188
    assert(n_start * BDRV_SECTOR_SIZE == offset_into_cluster(s, offset));
    offset = start_of_cluster(s, offset);

1189
again:
1190 1191
    start = offset + (n_start << BDRV_SECTOR_BITS);
    remaining = (n_end - n_start) << BDRV_SECTOR_BITS;
K
Kevin Wolf 已提交
1192 1193
    cluster_offset = 0;
    *host_offset = 0;
1194 1195
    cur_bytes = 0;
    *m = NULL;
K
Kevin Wolf 已提交
1196

1197
    while (true) {
1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214

        if (!*host_offset) {
            *host_offset = start_of_cluster(s, cluster_offset);
        }

        assert(remaining >= cur_bytes);

        start           += cur_bytes;
        remaining       -= cur_bytes;
        cluster_offset  += cur_bytes;

        if (remaining == 0) {
            break;
        }

        cur_bytes = remaining;

1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
        /*
         * Now start gathering as many contiguous clusters as possible:
         *
         * 1. Check for overlaps with in-flight allocations
         *
         *      a) Overlap not in the first cluster -> shorten this request and
         *         let the caller handle the rest in its next loop iteration.
         *
         *      b) Real overlaps of two requests. Yield and restart the search
         *         for contiguous clusters (the situation could have changed
         *         while we were sleeping)
         *
         *      c) TODO: Request starts in the same cluster as the in-flight
         *         allocation ends. Shorten the COW of the in-fight allocation,
         *         set cluster_offset to write to the same cluster and set up
         *         the right synchronisation between the in-flight request and
         *         the new one.
         */
1233
        ret = handle_dependencies(bs, start, &cur_bytes, m);
1234
        if (ret == -EAGAIN) {
1235 1236 1237 1238
            /* Currently handle_dependencies() doesn't yield if we already had
             * an allocation. If it did, we would have to clean up the L2Meta
             * structs before starting over. */
            assert(*m == NULL);
1239 1240 1241
            goto again;
        } else if (ret < 0) {
            return ret;
1242 1243
        } else if (cur_bytes == 0) {
            break;
1244 1245 1246 1247
        } else {
            /* handle_dependencies() may have decreased cur_bytes (shortened
             * the allocations below) so that the next dependency is processed
             * correctly during the next loop iteration. */
K
Kevin Wolf 已提交
1248
        }
1249

1250 1251 1252 1253 1254 1255 1256
        /*
         * 2. Count contiguous COPIED clusters.
         */
        ret = handle_copied(bs, start, &cluster_offset, &cur_bytes, m);
        if (ret < 0) {
            return ret;
        } else if (ret) {
1257
            continue;
1258 1259 1260
        } else if (cur_bytes == 0) {
            break;
        }
K
Kevin Wolf 已提交
1261

1262 1263 1264 1265 1266 1267 1268 1269
        /*
         * 3. If the request still hasn't completed, allocate new clusters,
         *    considering any cluster_offset of steps 1c or 2.
         */
        ret = handle_alloc(bs, start, &cluster_offset, &cur_bytes, m);
        if (ret < 0) {
            return ret;
        } else if (ret) {
1270
            continue;
1271 1272 1273 1274
        } else {
            assert(cur_bytes == 0);
            break;
        }
1275
    }
K
Kevin Wolf 已提交
1276

1277 1278 1279
    *num = (n_end - n_start) - (remaining >> BDRV_SECTOR_BITS);
    assert(*num > 0);
    assert(*host_offset != 0);
1280

1281
    return 0;
1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310
}

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

1311
int qcow2_decompress_cluster(BlockDriverState *bs, uint64_t cluster_offset)
1312
{
1313
    BDRVQcowState *s = bs->opaque;
1314 1315 1316 1317 1318 1319 1320 1321
    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;
1322 1323
        BLKDBG_EVENT(bs->file, BLKDBG_READ_COMPRESSED);
        ret = bdrv_read(bs->file, coffset >> 9, s->cluster_data, nb_csectors);
1324
        if (ret < 0) {
1325
            return ret;
1326 1327 1328
        }
        if (decompress_buffer(s->cluster_cache, s->cluster_size,
                              s->cluster_data + sector_offset, csize) < 0) {
1329
            return -EIO;
1330 1331 1332 1333 1334
        }
        s->cluster_cache_offset = coffset;
    }
    return 0;
}
K
Kevin Wolf 已提交
1335 1336 1337 1338 1339 1340 1341

/*
 * 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,
1342
    unsigned int nb_clusters, enum qcow2_discard_type type)
K
Kevin Wolf 已提交
1343 1344
{
    BDRVQcowState *s = bs->opaque;
1345
    uint64_t *l2_table;
K
Kevin Wolf 已提交
1346 1347 1348 1349
    int l2_index;
    int ret;
    int i;

1350
    ret = get_cluster_table(bs, offset, &l2_table, &l2_index);
K
Kevin Wolf 已提交
1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361
    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]);
1362
        if ((old_offset & L2E_OFFSET_MASK) == 0) {
K
Kevin Wolf 已提交
1363 1364 1365 1366 1367 1368 1369 1370
            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 */
1371
        qcow2_free_any_clusters(bs, old_offset, 1, type);
K
Kevin Wolf 已提交
1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
    }

    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,
1383
    int nb_sectors, enum qcow2_discard_type type)
K
Kevin Wolf 已提交
1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401
{
    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);

K
Kevin Wolf 已提交
1402 1403
    s->cache_discards = true;

K
Kevin Wolf 已提交
1404 1405
    /* Each L2 table is handled by its own loop iteration */
    while (nb_clusters > 0) {
1406
        ret = discard_single_l2(bs, offset, nb_clusters, type);
K
Kevin Wolf 已提交
1407
        if (ret < 0) {
K
Kevin Wolf 已提交
1408
            goto fail;
K
Kevin Wolf 已提交
1409 1410 1411 1412 1413 1414
        }

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

K
Kevin Wolf 已提交
1415 1416 1417 1418 1419 1420
    ret = 0;
fail:
    s->cache_discards = false;
    qcow2_process_discards(bs, ret);

    return ret;
K
Kevin Wolf 已提交
1421
}
K
Kevin Wolf 已提交
1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453

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

    ret = get_cluster_table(bs, offset, &l2_table, &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]);

        /* Update L2 entries */
        qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
        if (old_offset & QCOW_OFLAG_COMPRESSED) {
            l2_table[l2_index + i] = cpu_to_be64(QCOW_OFLAG_ZERO);
1454
            qcow2_free_any_clusters(bs, old_offset, 1, QCOW2_DISCARD_REQUEST);
K
Kevin Wolf 已提交
1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481
        } else {
            l2_table[l2_index + i] |= cpu_to_be64(QCOW_OFLAG_ZERO);
        }
    }

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

    return nb_clusters;
}

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

    /* The zero flag is only supported by version 3 and newer */
    if (s->qcow_version < 3) {
        return -ENOTSUP;
    }

    /* Each L2 table is handled by its own loop iteration */
    nb_clusters = size_to_clusters(s, nb_sectors << BDRV_SECTOR_BITS);

K
Kevin Wolf 已提交
1482 1483
    s->cache_discards = true;

K
Kevin Wolf 已提交
1484 1485 1486
    while (nb_clusters > 0) {
        ret = zero_single_l2(bs, offset, nb_clusters);
        if (ret < 0) {
K
Kevin Wolf 已提交
1487
            goto fail;
K
Kevin Wolf 已提交
1488 1489 1490 1491 1492 1493
        }

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

K
Kevin Wolf 已提交
1494 1495 1496 1497 1498 1499
    ret = 0;
fail:
    s->cache_discards = false;
    qcow2_process_discards(bs, ret);

    return ret;
K
Kevin Wolf 已提交
1500
}
M
Max Reitz 已提交
1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512

/*
 * Expands all zero clusters in a specific L1 table (or deallocates them, for
 * non-backed non-pre-allocated zero clusters).
 *
 * expanded_clusters is a bitmap where every bit corresponds to one cluster in
 * the image file; a bit gets set if the corresponding cluster has been used for
 * zero expansion (i.e., has been filled with zeroes and is referenced from an
 * L2 table). nb_clusters contains the total cluster count of the image file,
 * i.e., the number of bits in expanded_clusters.
 */
static int expand_zero_clusters_in_l1(BlockDriverState *bs, uint64_t *l1_table,
1513 1514
                                      int l1_size, uint8_t **expanded_clusters,
                                      uint64_t *nb_clusters)
M
Max Reitz 已提交
1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556
{
    BDRVQcowState *s = bs->opaque;
    bool is_active_l1 = (l1_table == s->l1_table);
    uint64_t *l2_table = NULL;
    int ret;
    int i, j;

    if (!is_active_l1) {
        /* inactive L2 tables require a buffer to be stored in when loading
         * them from disk */
        l2_table = qemu_blockalign(bs, s->cluster_size);
    }

    for (i = 0; i < l1_size; i++) {
        uint64_t l2_offset = l1_table[i] & L1E_OFFSET_MASK;
        bool l2_dirty = false;

        if (!l2_offset) {
            /* unallocated */
            continue;
        }

        if (is_active_l1) {
            /* get active L2 tables from cache */
            ret = qcow2_cache_get(bs, s->l2_table_cache, l2_offset,
                    (void **)&l2_table);
        } else {
            /* load inactive L2 tables from disk */
            ret = bdrv_read(bs->file, l2_offset / BDRV_SECTOR_SIZE,
                    (void *)l2_table, s->cluster_sectors);
        }
        if (ret < 0) {
            goto fail;
        }

        for (j = 0; j < s->l2_size; j++) {
            uint64_t l2_entry = be64_to_cpu(l2_table[j]);
            int64_t offset = l2_entry & L2E_OFFSET_MASK, cluster_index;
            int cluster_type = qcow2_get_cluster_type(l2_entry);

            if (cluster_type == QCOW2_CLUSTER_NORMAL) {
                cluster_index = offset >> s->cluster_bits;
1557 1558
                assert((cluster_index >= 0) && (cluster_index < *nb_clusters));
                if ((*expanded_clusters)[cluster_index / 8] &
M
Max Reitz 已提交
1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615
                    (1 << (cluster_index % 8))) {
                    /* Probably a shared L2 table; this cluster was a zero
                     * cluster which has been expanded, its refcount
                     * therefore most likely requires an update. */
                    ret = qcow2_update_cluster_refcount(bs, cluster_index, 1,
                                                        QCOW2_DISCARD_NEVER);
                    if (ret < 0) {
                        goto fail;
                    }
                    /* Since we just increased the refcount, the COPIED flag may
                     * no longer be set. */
                    l2_table[j] = cpu_to_be64(l2_entry & ~QCOW_OFLAG_COPIED);
                    l2_dirty = true;
                }
                continue;
            }
            else if (qcow2_get_cluster_type(l2_entry) != QCOW2_CLUSTER_ZERO) {
                continue;
            }

            if (!offset) {
                /* not preallocated */
                if (!bs->backing_hd) {
                    /* not backed; therefore we can simply deallocate the
                     * cluster */
                    l2_table[j] = 0;
                    l2_dirty = true;
                    continue;
                }

                offset = qcow2_alloc_clusters(bs, s->cluster_size);
                if (offset < 0) {
                    ret = offset;
                    goto fail;
                }
            }

            ret = qcow2_pre_write_overlap_check(bs, QCOW2_OL_DEFAULT,
                                                offset, s->cluster_size);
            if (ret < 0) {
                qcow2_free_clusters(bs, offset, s->cluster_size,
                        QCOW2_DISCARD_ALWAYS);
                goto fail;
            }

            ret = bdrv_write_zeroes(bs->file, offset / BDRV_SECTOR_SIZE,
                                    s->cluster_sectors);
            if (ret < 0) {
                qcow2_free_clusters(bs, offset, s->cluster_size,
                        QCOW2_DISCARD_ALWAYS);
                goto fail;
            }

            l2_table[j] = cpu_to_be64(offset | QCOW_OFLAG_COPIED);
            l2_dirty = true;

            cluster_index = offset >> s->cluster_bits;
1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634

            if (cluster_index >= *nb_clusters) {
                uint64_t old_bitmap_size = (*nb_clusters + 7) / 8;
                uint64_t new_bitmap_size;
                /* The offset may lie beyond the old end of the underlying image
                 * file for growable files only */
                assert(bs->file->growable);
                *nb_clusters = size_to_clusters(s, bs->file->total_sectors *
                                                BDRV_SECTOR_SIZE);
                new_bitmap_size = (*nb_clusters + 7) / 8;
                *expanded_clusters = g_realloc(*expanded_clusters,
                                               new_bitmap_size);
                /* clear the newly allocated space */
                memset(&(*expanded_clusters)[old_bitmap_size], 0,
                       new_bitmap_size - old_bitmap_size);
            }

            assert((cluster_index >= 0) && (cluster_index < *nb_clusters));
            (*expanded_clusters)[cluster_index / 8] |= 1 << (cluster_index % 8);
M
Max Reitz 已提交
1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697
        }

        if (is_active_l1) {
            if (l2_dirty) {
                qcow2_cache_entry_mark_dirty(s->l2_table_cache, l2_table);
                qcow2_cache_depends_on_flush(s->l2_table_cache);
            }
            ret = qcow2_cache_put(bs, s->l2_table_cache, (void **)&l2_table);
            if (ret < 0) {
                l2_table = NULL;
                goto fail;
            }
        } else {
            if (l2_dirty) {
                ret = qcow2_pre_write_overlap_check(bs, QCOW2_OL_DEFAULT &
                        ~(QCOW2_OL_INACTIVE_L2 | QCOW2_OL_ACTIVE_L2), l2_offset,
                        s->cluster_size);
                if (ret < 0) {
                    goto fail;
                }

                ret = bdrv_write(bs->file, l2_offset / BDRV_SECTOR_SIZE,
                        (void *)l2_table, s->cluster_sectors);
                if (ret < 0) {
                    goto fail;
                }
            }
        }
    }

    ret = 0;

fail:
    if (l2_table) {
        if (!is_active_l1) {
            qemu_vfree(l2_table);
        } else {
            if (ret < 0) {
                qcow2_cache_put(bs, s->l2_table_cache, (void **)&l2_table);
            } else {
                ret = qcow2_cache_put(bs, s->l2_table_cache,
                        (void **)&l2_table);
            }
        }
    }
    return ret;
}

/*
 * For backed images, expands all zero clusters on the image. For non-backed
 * images, deallocates all non-pre-allocated zero clusters (and claims the
 * allocation for pre-allocated ones). This is important for downgrading to a
 * qcow2 version which doesn't yet support metadata zero clusters.
 */
int qcow2_expand_zero_clusters(BlockDriverState *bs)
{
    BDRVQcowState *s = bs->opaque;
    uint64_t *l1_table = NULL;
    uint64_t nb_clusters;
    uint8_t *expanded_clusters;
    int ret;
    int i, j;

1698 1699
    nb_clusters = size_to_clusters(s, bs->file->total_sectors *
                                   BDRV_SECTOR_SIZE);
M
Max Reitz 已提交
1700 1701 1702
    expanded_clusters = g_malloc0((nb_clusters + 7) / 8);

    ret = expand_zero_clusters_in_l1(bs, s->l1_table, s->l1_size,
1703
                                     &expanded_clusters, &nb_clusters);
M
Max Reitz 已提交
1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736
    if (ret < 0) {
        goto fail;
    }

    /* Inactive L1 tables may point to active L2 tables - therefore it is
     * necessary to flush the L2 table cache before trying to access the L2
     * tables pointed to by inactive L1 entries (else we might try to expand
     * zero clusters that have already been expanded); furthermore, it is also
     * necessary to empty the L2 table cache, since it may contain tables which
     * are now going to be modified directly on disk, bypassing the cache.
     * qcow2_cache_empty() does both for us. */
    ret = qcow2_cache_empty(bs, s->l2_table_cache);
    if (ret < 0) {
        goto fail;
    }

    for (i = 0; i < s->nb_snapshots; i++) {
        int l1_sectors = (s->snapshots[i].l1_size * sizeof(uint64_t) +
                BDRV_SECTOR_SIZE - 1) / BDRV_SECTOR_SIZE;

        l1_table = g_realloc(l1_table, l1_sectors * BDRV_SECTOR_SIZE);

        ret = bdrv_read(bs->file, s->snapshots[i].l1_table_offset /
                BDRV_SECTOR_SIZE, (void *)l1_table, l1_sectors);
        if (ret < 0) {
            goto fail;
        }

        for (j = 0; j < s->snapshots[i].l1_size; j++) {
            be64_to_cpus(&l1_table[j]);
        }

        ret = expand_zero_clusters_in_l1(bs, l1_table, s->snapshots[i].l1_size,
1737
                                         &expanded_clusters, &nb_clusters);
M
Max Reitz 已提交
1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749
        if (ret < 0) {
            goto fail;
        }
    }

    ret = 0;

fail:
    g_free(expanded_clusters);
    g_free(l1_table);
    return ret;
}