]> git.proxmox.com Git - mirror_qemu.git/blame - block/vpc.c
vmdk: Handle failure for potentially large allocations
[mirror_qemu.git] / block / vpc.c
CommitLineData
6a0f9e82 1/*
cc2040f8 2 * Block driver for Connectix / Microsoft Virtual PC images
5fafdf24 3 *
6a0f9e82 4 * Copyright (c) 2005 Alex Beregszaszi
15d35bc5 5 * Copyright (c) 2009 Kevin Wolf <kwolf@suse.de>
5fafdf24 6 *
6a0f9e82
FB
7 * Permission is hereby granted, free of charge, to any person obtaining a copy
8 * of this software and associated documentation files (the "Software"), to deal
9 * in the Software without restriction, including without limitation the rights
10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
11 * copies of the Software, and to permit persons to whom the Software is
12 * furnished to do so, subject to the following conditions:
13 *
14 * The above copyright notice and this permission notice shall be included in
15 * all copies or substantial portions of the Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
23 * THE SOFTWARE.
24 */
faf07963 25#include "qemu-common.h"
737e150e 26#include "block/block_int.h"
1de7afc9 27#include "qemu/module.h"
caf71f86 28#include "migration/migration.h"
1fe1fa51
CA
29#if defined(CONFIG_UUID)
30#include <uuid/uuid.h>
31#endif
6a0f9e82
FB
32
33/**************************************************************/
34
35#define HEADER_SIZE 512
36
37//#define CACHE
38
2cfacb62
AL
39enum vhd_type {
40 VHD_FIXED = 2,
41 VHD_DYNAMIC = 3,
42 VHD_DIFFERENCING = 4,
43};
44
57c7d9e5
AL
45// Seconds since Jan 1, 2000 0:00:00 (UTC)
46#define VHD_TIMESTAMP_BASE 946684800
47
97f1c45c
JC
48#define VHD_MAX_SECTORS (65535LL * 255 * 255)
49
6a0f9e82 50// always big-endian
e54835c0 51typedef struct vhd_footer {
2cfacb62
AL
52 char creator[8]; // "conectix"
53 uint32_t features;
54 uint32_t version;
55
56 // Offset of next header structure, 0xFFFFFFFF if none
57 uint64_t data_offset;
58
59 // Seconds since Jan 1, 2000 0:00:00 (UTC)
60 uint32_t timestamp;
61
62 char creator_app[4]; // "vpc "
63 uint16_t major;
64 uint16_t minor;
65 char creator_os[4]; // "Wi2k"
66
67 uint64_t orig_size;
68 uint64_t size;
69
70 uint16_t cyls;
71 uint8_t heads;
72 uint8_t secs_per_cyl;
73
74 uint32_t type;
75
76 // Checksum of the Hard Disk Footer ("one's complement of the sum of all
77 // the bytes in the footer without the checksum field")
78 uint32_t checksum;
79
80 // UUID used to identify a parent hard disk (backing file)
81 uint8_t uuid[16];
82
83 uint8_t in_saved_state;
e54835c0 84} QEMU_PACKED VHDFooter;
b9fa33a6 85
e54835c0 86typedef struct vhd_dyndisk_header {
2cfacb62
AL
87 char magic[8]; // "cxsparse"
88
89 // Offset of next header structure, 0xFFFFFFFF if none
90 uint64_t data_offset;
91
92 // Offset of the Block Allocation Table (BAT)
93 uint64_t table_offset;
94
95 uint32_t version;
96 uint32_t max_table_entries; // 32bit/entry
97
98 // 2 MB by default, must be a power of two
99 uint32_t block_size;
100
101 uint32_t checksum;
102 uint8_t parent_uuid[16];
103 uint32_t parent_timestamp;
104 uint32_t reserved;
105
106 // Backing file name (in UTF-16)
107 uint8_t parent_name[512];
108
109 struct {
110 uint32_t platform;
111 uint32_t data_space;
112 uint32_t data_length;
113 uint32_t reserved;
114 uint64_t data_offset;
115 } parent_locator[8];
e54835c0 116} QEMU_PACKED VHDDynDiskHeader;
6a0f9e82
FB
117
118typedef struct BDRVVPCState {
848c66e8 119 CoMutex lock;
15d35bc5
AL
120 uint8_t footer_buf[HEADER_SIZE];
121 uint64_t free_data_block_offset;
2cfacb62 122 int max_table_entries;
6a0f9e82 123 uint32_t *pagetable;
15d35bc5
AL
124 uint64_t bat_offset;
125 uint64_t last_bitmap_offset;
6a0f9e82 126
2cfacb62 127 uint32_t block_size;
15d35bc5
AL
128 uint32_t bitmap_size;
129
6a0f9e82
FB
130#ifdef CACHE
131 uint8_t *pageentry_u8;
132 uint32_t *pageentry_u32;
133 uint16_t *pageentry_u16;
3b46e624 134
6a0f9e82
FB
135 uint64_t last_bitmap;
136#endif
612ff3d8
KW
137
138 Error *migration_blocker;
6a0f9e82
FB
139} BDRVVPCState;
140
57c7d9e5
AL
141static uint32_t vpc_checksum(uint8_t* buf, size_t size)
142{
143 uint32_t res = 0;
144 int i;
145
146 for (i = 0; i < size; i++)
147 res += buf[i];
148
149 return ~res;
150}
151
152
6a0f9e82
FB
153static int vpc_probe(const uint8_t *buf, int buf_size, const char *filename)
154{
ffe8ab83 155 if (buf_size >= 8 && !strncmp((char *)buf, "conectix", 8))
6a0f9e82 156 return 100;
6a0f9e82
FB
157 return 0;
158}
159
015a1036
HR
160static int vpc_open(BlockDriverState *bs, QDict *options, int flags,
161 Error **errp)
6a0f9e82
FB
162{
163 BDRVVPCState *s = bs->opaque;
66f82cee 164 int i;
e54835c0
JC
165 VHDFooter *footer;
166 VHDDynDiskHeader *dyndisk_header;
b9fa33a6 167 uint8_t buf[HEADER_SIZE];
57c7d9e5 168 uint32_t checksum;
97f1c45c 169 uint64_t computed_size;
24da78db 170 int disk_type = VHD_DYNAMIC;
59294e46 171 int ret;
6a0f9e82 172
59294e46
KW
173 ret = bdrv_pread(bs->file, 0, s->footer_buf, HEADER_SIZE);
174 if (ret < 0) {
6a0f9e82 175 goto fail;
59294e46 176 }
6a0f9e82 177
e54835c0 178 footer = (VHDFooter *) s->footer_buf;
24da78db
CA
179 if (strncmp(footer->creator, "conectix", 8)) {
180 int64_t offset = bdrv_getlength(bs->file);
59294e46
KW
181 if (offset < 0) {
182 ret = offset;
183 goto fail;
184 } else if (offset < HEADER_SIZE) {
185 ret = -EINVAL;
24da78db
CA
186 goto fail;
187 }
59294e46 188
24da78db 189 /* If a fixed disk, the footer is found only at the end of the file */
59294e46
KW
190 ret = bdrv_pread(bs->file, offset-HEADER_SIZE, s->footer_buf,
191 HEADER_SIZE);
192 if (ret < 0) {
24da78db
CA
193 goto fail;
194 }
195 if (strncmp(footer->creator, "conectix", 8)) {
76abe407
PB
196 error_setg(errp, "invalid VPC image");
197 ret = -EINVAL;
24da78db
CA
198 goto fail;
199 }
200 disk_type = VHD_FIXED;
201 }
6a0f9e82 202
57c7d9e5
AL
203 checksum = be32_to_cpu(footer->checksum);
204 footer->checksum = 0;
205 if (vpc_checksum(s->footer_buf, HEADER_SIZE) != checksum)
206 fprintf(stderr, "block-vpc: The header checksum of '%s' is "
66f82cee 207 "incorrect.\n", bs->filename);
57c7d9e5 208
c088b691
ZS
209 /* Write 'checksum' back to footer, or else will leave it with zero. */
210 footer->checksum = be32_to_cpu(checksum);
211
33ccf667
SH
212 // The visible size of a image in Virtual PC depends on the geometry
213 // rather than on the size stored in the footer (the size in the footer
214 // is too large usually)
215 bs->total_sectors = (int64_t)
216 be16_to_cpu(footer->cyls) * footer->heads * footer->secs_per_cyl;
1fa79228 217
0173e7bb
PL
218 /* images created with disk2vhd report a far higher virtual size
219 * than expected with the cyls * heads * sectors_per_cyl formula.
220 * use the footer->size instead if the image was created with
221 * disk2vhd.
222 */
223 if (!strncmp(footer->creator_app, "d2v", 4)) {
224 bs->total_sectors = be64_to_cpu(footer->size) / BDRV_SECTOR_SIZE;
225 }
226
258d2edb 227 /* Allow a maximum disk size of approximately 2 TB */
97f1c45c 228 if (bs->total_sectors >= VHD_MAX_SECTORS) {
59294e46 229 ret = -EFBIG;
efc8243d
SH
230 goto fail;
231 }
232
24da78db 233 if (disk_type == VHD_DYNAMIC) {
59294e46
KW
234 ret = bdrv_pread(bs->file, be64_to_cpu(footer->data_offset), buf,
235 HEADER_SIZE);
236 if (ret < 0) {
24da78db
CA
237 goto fail;
238 }
b9fa33a6 239
e54835c0 240 dyndisk_header = (VHDDynDiskHeader *) buf;
6a0f9e82 241
24da78db 242 if (strncmp(dyndisk_header->magic, "cxsparse", 8)) {
59294e46 243 ret = -EINVAL;
24da78db
CA
244 goto fail;
245 }
6a0f9e82 246
24da78db 247 s->block_size = be32_to_cpu(dyndisk_header->block_size);
5e71dfad
KW
248 if (!is_power_of_2(s->block_size) || s->block_size < BDRV_SECTOR_SIZE) {
249 error_setg(errp, "Invalid block size %" PRIu32, s->block_size);
250 ret = -EINVAL;
251 goto fail;
252 }
24da78db 253 s->bitmap_size = ((s->block_size / (8 * 512)) + 511) & ~511;
15d35bc5 254
24da78db 255 s->max_table_entries = be32_to_cpu(dyndisk_header->max_table_entries);
97f1c45c
JC
256
257 if ((bs->total_sectors * 512) / s->block_size > 0xffffffffU) {
258 ret = -EINVAL;
259 goto fail;
260 }
261 if (s->max_table_entries > (VHD_MAX_SECTORS * 512) / s->block_size) {
262 ret = -EINVAL;
263 goto fail;
264 }
265
266 computed_size = (uint64_t) s->max_table_entries * s->block_size;
267 if (computed_size < bs->total_sectors * 512) {
268 ret = -EINVAL;
269 goto fail;
270 }
271
272 s->pagetable = qemu_blockalign(bs, s->max_table_entries * 4);
b71d1c2e 273
24da78db 274 s->bat_offset = be64_to_cpu(dyndisk_header->table_offset);
59294e46
KW
275
276 ret = bdrv_pread(bs->file, s->bat_offset, s->pagetable,
277 s->max_table_entries * 4);
278 if (ret < 0) {
24da78db
CA
279 goto fail;
280 }
b71d1c2e 281
24da78db
CA
282 s->free_data_block_offset =
283 (s->bat_offset + (s->max_table_entries * 4) + 511) & ~511;
15d35bc5 284
24da78db
CA
285 for (i = 0; i < s->max_table_entries; i++) {
286 be32_to_cpus(&s->pagetable[i]);
287 if (s->pagetable[i] != 0xFFFFFFFF) {
288 int64_t next = (512 * (int64_t) s->pagetable[i]) +
289 s->bitmap_size + s->block_size;
15d35bc5 290
24da78db
CA
291 if (next > s->free_data_block_offset) {
292 s->free_data_block_offset = next;
293 }
294 }
15d35bc5 295 }
15d35bc5 296
fb8fe35f
PL
297 if (s->free_data_block_offset > bdrv_getlength(bs->file)) {
298 error_setg(errp, "block-vpc: free_data_block_offset points after "
299 "the end of file. The image has been truncated.");
300 ret = -EINVAL;
301 goto fail;
302 }
303
24da78db 304 s->last_bitmap_offset = (int64_t) -1;
6a0f9e82 305
6a0f9e82 306#ifdef CACHE
24da78db
CA
307 s->pageentry_u8 = g_malloc(512);
308 s->pageentry_u32 = s->pageentry_u8;
309 s->pageentry_u16 = s->pageentry_u8;
310 s->last_pagetable = -1;
6a0f9e82 311#endif
24da78db 312 }
6a0f9e82 313
848c66e8 314 qemu_co_mutex_init(&s->lock);
612ff3d8
KW
315
316 /* Disable migration when VHD images are used */
317 error_set(&s->migration_blocker,
318 QERR_BLOCK_FORMAT_FEATURE_NOT_SUPPORTED,
319 "vpc", bs->device_name, "live migration");
320 migrate_add_blocker(s->migration_blocker);
321
6a0f9e82 322 return 0;
59294e46
KW
323
324fail:
97f1c45c 325 qemu_vfree(s->pagetable);
59294e46
KW
326#ifdef CACHE
327 g_free(s->pageentry_u8);
328#endif
329 return ret;
6a0f9e82
FB
330}
331
3fe4b700
JC
332static int vpc_reopen_prepare(BDRVReopenState *state,
333 BlockReopenQueue *queue, Error **errp)
334{
335 return 0;
336}
337
b71d1c2e
AL
338/*
339 * Returns the absolute byte offset of the given sector in the image file.
340 * If the sector is not allocated, -1 is returned instead.
15d35bc5
AL
341 *
342 * The parameter write must be 1 if the offset will be used for a write
343 * operation (the block bitmaps is updated then), 0 otherwise.
b71d1c2e 344 */
15d35bc5
AL
345static inline int64_t get_sector_offset(BlockDriverState *bs,
346 int64_t sector_num, int write)
6a0f9e82
FB
347{
348 BDRVVPCState *s = bs->opaque;
349 uint64_t offset = sector_num * 512;
350 uint64_t bitmap_offset, block_offset;
351 uint32_t pagetable_index, pageentry_index;
352
2cfacb62
AL
353 pagetable_index = offset / s->block_size;
354 pageentry_index = (offset % s->block_size) / 512;
3b46e624 355
15d35bc5
AL
356 if (pagetable_index >= s->max_table_entries || s->pagetable[pagetable_index] == 0xffffffff)
357 return -1; // not allocated
6a0f9e82 358
378e2aea 359 bitmap_offset = 512 * (uint64_t) s->pagetable[pagetable_index];
15d35bc5
AL
360 block_offset = bitmap_offset + s->bitmap_size + (512 * pageentry_index);
361
362 // We must ensure that we don't write to any sectors which are marked as
363 // unused in the bitmap. We get away with setting all bits in the block
364 // bitmap each time we write to a new block. This might cause Virtual PC to
365 // miss sparse read optimization, but it's not a problem in terms of
366 // correctness.
367 if (write && (s->last_bitmap_offset != bitmap_offset)) {
368 uint8_t bitmap[s->bitmap_size];
369
370 s->last_bitmap_offset = bitmap_offset;
371 memset(bitmap, 0xff, s->bitmap_size);
078a458e 372 bdrv_pwrite_sync(bs->file, bitmap_offset, bitmap, s->bitmap_size);
15d35bc5 373 }
3b46e624 374
26a76461 375// printf("sector: %" PRIx64 ", index: %x, offset: %x, bioff: %" PRIx64 ", bloff: %" PRIx64 "\n",
6a0f9e82
FB
376// sector_num, pagetable_index, pageentry_index,
377// bitmap_offset, block_offset);
378
379// disabled by reason
380#if 0
381#ifdef CACHE
382 if (bitmap_offset != s->last_bitmap)
383 {
384 lseek(s->fd, bitmap_offset, SEEK_SET);
385
386 s->last_bitmap = bitmap_offset;
5fafdf24 387
6a0f9e82
FB
388 // Scary! Bitmap is stored as big endian 32bit entries,
389 // while we used to look it up byte by byte
390 read(s->fd, s->pageentry_u8, 512);
391 for (i = 0; i < 128; i++)
392 be32_to_cpus(&s->pageentry_u32[i]);
393 }
394
395 if ((s->pageentry_u8[pageentry_index / 8] >> (pageentry_index % 8)) & 1)
396 return -1;
397#else
398 lseek(s->fd, bitmap_offset + (pageentry_index / 8), SEEK_SET);
5fafdf24 399
6a0f9e82
FB
400 read(s->fd, &bitmap_entry, 1);
401
402 if ((bitmap_entry >> (pageentry_index % 8)) & 1)
403 return -1; // not allocated
404#endif
405#endif
6a0f9e82 406
b71d1c2e 407 return block_offset;
6a0f9e82
FB
408}
409
15d35bc5
AL
410/*
411 * Writes the footer to the end of the image file. This is needed when the
412 * file grows as it overwrites the old footer
413 *
414 * Returns 0 on success and < 0 on error
415 */
416static int rewrite_footer(BlockDriverState* bs)
417{
418 int ret;
419 BDRVVPCState *s = bs->opaque;
420 int64_t offset = s->free_data_block_offset;
421
078a458e 422 ret = bdrv_pwrite_sync(bs->file, offset, s->footer_buf, HEADER_SIZE);
15d35bc5
AL
423 if (ret < 0)
424 return ret;
425
426 return 0;
427}
428
429/*
430 * Allocates a new block. This involves writing a new footer and updating
431 * the Block Allocation Table to use the space at the old end of the image
432 * file (overwriting the old footer)
433 *
434 * Returns the sectors' offset in the image file on success and < 0 on error
435 */
436static int64_t alloc_block(BlockDriverState* bs, int64_t sector_num)
437{
438 BDRVVPCState *s = bs->opaque;
439 int64_t bat_offset;
440 uint32_t index, bat_value;
441 int ret;
442 uint8_t bitmap[s->bitmap_size];
443
444 // Check if sector_num is valid
445 if ((sector_num < 0) || (sector_num > bs->total_sectors))
446 return -1;
447
448 // Write entry into in-memory BAT
449 index = (sector_num * 512) / s->block_size;
450 if (s->pagetable[index] != 0xFFFFFFFF)
451 return -1;
452
453 s->pagetable[index] = s->free_data_block_offset / 512;
454
455 // Initialize the block's bitmap
456 memset(bitmap, 0xff, s->bitmap_size);
5bb1cbac 457 ret = bdrv_pwrite_sync(bs->file, s->free_data_block_offset, bitmap,
078a458e 458 s->bitmap_size);
5bb1cbac
KW
459 if (ret < 0) {
460 return ret;
461 }
15d35bc5
AL
462
463 // Write new footer (the old one will be overwritten)
464 s->free_data_block_offset += s->block_size + s->bitmap_size;
465 ret = rewrite_footer(bs);
466 if (ret < 0)
467 goto fail;
468
469 // Write BAT entry to disk
470 bat_offset = s->bat_offset + (4 * index);
471 bat_value = be32_to_cpu(s->pagetable[index]);
078a458e 472 ret = bdrv_pwrite_sync(bs->file, bat_offset, &bat_value, 4);
15d35bc5
AL
473 if (ret < 0)
474 goto fail;
475
476 return get_sector_offset(bs, sector_num, 0);
477
478fail:
479 s->free_data_block_offset -= (s->block_size + s->bitmap_size);
480 return -1;
481}
482
97b00e28
PB
483static int vpc_get_info(BlockDriverState *bs, BlockDriverInfo *bdi)
484{
485 BDRVVPCState *s = (BDRVVPCState *)bs->opaque;
486 VHDFooter *footer = (VHDFooter *) s->footer_buf;
487
488 if (cpu_to_be32(footer->type) != VHD_FIXED) {
489 bdi->cluster_size = s->block_size;
490 }
491
95de6d70 492 bdi->unallocated_blocks_are_zero = true;
97b00e28
PB
493 return 0;
494}
495
5fafdf24 496static int vpc_read(BlockDriverState *bs, int64_t sector_num,
6a0f9e82
FB
497 uint8_t *buf, int nb_sectors)
498{
6c6ea921 499 BDRVVPCState *s = bs->opaque;
6a0f9e82 500 int ret;
b71d1c2e 501 int64_t offset;
6c6ea921 502 int64_t sectors, sectors_per_block;
e54835c0 503 VHDFooter *footer = (VHDFooter *) s->footer_buf;
6a0f9e82 504
24da78db
CA
505 if (cpu_to_be32(footer->type) == VHD_FIXED) {
506 return bdrv_read(bs->file, sector_num, buf, nb_sectors);
507 }
6a0f9e82 508 while (nb_sectors > 0) {
15d35bc5 509 offset = get_sector_offset(bs, sector_num, 0);
b71d1c2e 510
6c6ea921
KW
511 sectors_per_block = s->block_size >> BDRV_SECTOR_BITS;
512 sectors = sectors_per_block - (sector_num % sectors_per_block);
513 if (sectors > nb_sectors) {
514 sectors = nb_sectors;
515 }
516
b71d1c2e 517 if (offset == -1) {
6c6ea921 518 memset(buf, 0, sectors * BDRV_SECTOR_SIZE);
b71d1c2e 519 } else {
6c6ea921
KW
520 ret = bdrv_pread(bs->file, offset, buf,
521 sectors * BDRV_SECTOR_SIZE);
522 if (ret != sectors * BDRV_SECTOR_SIZE) {
b71d1c2e 523 return -1;
6c6ea921 524 }
b71d1c2e
AL
525 }
526
6c6ea921
KW
527 nb_sectors -= sectors;
528 sector_num += sectors;
529 buf += sectors * BDRV_SECTOR_SIZE;
6a0f9e82
FB
530 }
531 return 0;
532}
533
2914caa0
PB
534static coroutine_fn int vpc_co_read(BlockDriverState *bs, int64_t sector_num,
535 uint8_t *buf, int nb_sectors)
536{
537 int ret;
538 BDRVVPCState *s = bs->opaque;
539 qemu_co_mutex_lock(&s->lock);
540 ret = vpc_read(bs, sector_num, buf, nb_sectors);
541 qemu_co_mutex_unlock(&s->lock);
542 return ret;
543}
544
15d35bc5
AL
545static int vpc_write(BlockDriverState *bs, int64_t sector_num,
546 const uint8_t *buf, int nb_sectors)
547{
6c6ea921 548 BDRVVPCState *s = bs->opaque;
15d35bc5 549 int64_t offset;
6c6ea921 550 int64_t sectors, sectors_per_block;
15d35bc5 551 int ret;
e54835c0 552 VHDFooter *footer = (VHDFooter *) s->footer_buf;
15d35bc5 553
24da78db
CA
554 if (cpu_to_be32(footer->type) == VHD_FIXED) {
555 return bdrv_write(bs->file, sector_num, buf, nb_sectors);
556 }
15d35bc5
AL
557 while (nb_sectors > 0) {
558 offset = get_sector_offset(bs, sector_num, 1);
559
6c6ea921
KW
560 sectors_per_block = s->block_size >> BDRV_SECTOR_BITS;
561 sectors = sectors_per_block - (sector_num % sectors_per_block);
562 if (sectors > nb_sectors) {
563 sectors = nb_sectors;
564 }
565
15d35bc5
AL
566 if (offset == -1) {
567 offset = alloc_block(bs, sector_num);
568 if (offset < 0)
569 return -1;
570 }
571
6c6ea921
KW
572 ret = bdrv_pwrite(bs->file, offset, buf, sectors * BDRV_SECTOR_SIZE);
573 if (ret != sectors * BDRV_SECTOR_SIZE) {
15d35bc5 574 return -1;
6c6ea921 575 }
15d35bc5 576
6c6ea921
KW
577 nb_sectors -= sectors;
578 sector_num += sectors;
579 buf += sectors * BDRV_SECTOR_SIZE;
15d35bc5
AL
580 }
581
582 return 0;
583}
584
e183ef75
PB
585static coroutine_fn int vpc_co_write(BlockDriverState *bs, int64_t sector_num,
586 const uint8_t *buf, int nb_sectors)
587{
588 int ret;
589 BDRVVPCState *s = bs->opaque;
590 qemu_co_mutex_lock(&s->lock);
591 ret = vpc_write(bs, sector_num, buf, nb_sectors);
592 qemu_co_mutex_unlock(&s->lock);
593 return ret;
594}
595
57c7d9e5
AL
596/*
597 * Calculates the number of cylinders, heads and sectors per cylinder
598 * based on a given number of sectors. This is the algorithm described
599 * in the VHD specification.
600 *
601 * Note that the geometry doesn't always exactly match total_sectors but
602 * may round it down.
6e9ea0c0 603 *
258d2edb
CA
604 * Returns 0 on success, -EFBIG if the size is larger than ~2 TB. Override
605 * the hardware EIDE and ATA-2 limit of 16 heads (max disk size of 127 GB)
606 * and instead allow up to 255 heads.
57c7d9e5 607 */
6e9ea0c0 608static int calculate_geometry(int64_t total_sectors, uint16_t* cyls,
57c7d9e5
AL
609 uint8_t* heads, uint8_t* secs_per_cyl)
610{
611 uint32_t cyls_times_heads;
612
258d2edb
CA
613 /* Allow a maximum disk size of approximately 2 TB */
614 if (total_sectors > 65535LL * 255 * 255) {
6e9ea0c0 615 return -EFBIG;
258d2edb 616 }
57c7d9e5
AL
617
618 if (total_sectors > 65535 * 16 * 63) {
619 *secs_per_cyl = 255;
258d2edb
CA
620 if (total_sectors > 65535 * 16 * 255) {
621 *heads = 255;
622 } else {
623 *heads = 16;
624 }
57c7d9e5
AL
625 cyls_times_heads = total_sectors / *secs_per_cyl;
626 } else {
627 *secs_per_cyl = 17;
628 cyls_times_heads = total_sectors / *secs_per_cyl;
629 *heads = (cyls_times_heads + 1023) / 1024;
630
631 if (*heads < 4)
632 *heads = 4;
633
634 if (cyls_times_heads >= (*heads * 1024) || *heads > 16) {
635 *secs_per_cyl = 31;
636 *heads = 16;
637 cyls_times_heads = total_sectors / *secs_per_cyl;
638 }
639
640 if (cyls_times_heads >= (*heads * 1024)) {
641 *secs_per_cyl = 63;
642 *heads = 16;
643 cyls_times_heads = total_sectors / *secs_per_cyl;
644 }
645 }
646
dede4188 647 *cyls = cyls_times_heads / *heads;
6e9ea0c0
AJ
648
649 return 0;
57c7d9e5
AL
650}
651
fef6070e
JC
652static int create_dynamic_disk(BlockDriverState *bs, uint8_t *buf,
653 int64_t total_sectors)
57c7d9e5 654{
e54835c0
JC
655 VHDDynDiskHeader *dyndisk_header =
656 (VHDDynDiskHeader *) buf;
57c7d9e5 657 size_t block_size, num_bat_entries;
24da78db 658 int i;
fef6070e
JC
659 int ret;
660 int64_t offset = 0;
57c7d9e5 661
57c7d9e5
AL
662 // Write the footer (twice: at the beginning and at the end)
663 block_size = 0x200000;
664 num_bat_entries = (total_sectors + block_size / 512) / (block_size / 512);
665
fef6070e
JC
666 ret = bdrv_pwrite_sync(bs, offset, buf, HEADER_SIZE);
667 if (ret) {
f0ff243a
BS
668 goto fail;
669 }
57c7d9e5 670
fef6070e
JC
671 offset = 1536 + ((num_bat_entries * 4 + 511) & ~511);
672 ret = bdrv_pwrite_sync(bs, offset, buf, HEADER_SIZE);
673 if (ret < 0) {
f0ff243a
BS
674 goto fail;
675 }
57c7d9e5
AL
676
677 // Write the initial BAT
fef6070e 678 offset = 3 * 512;
57c7d9e5
AL
679
680 memset(buf, 0xFF, 512);
f0ff243a 681 for (i = 0; i < (num_bat_entries * 4 + 511) / 512; i++) {
fef6070e
JC
682 ret = bdrv_pwrite_sync(bs, offset, buf, 512);
683 if (ret < 0) {
f0ff243a
BS
684 goto fail;
685 }
fef6070e 686 offset += 512;
f0ff243a 687 }
57c7d9e5 688
57c7d9e5
AL
689 // Prepare the Dynamic Disk Header
690 memset(buf, 0, 1024);
691
5ec4d682 692 memcpy(dyndisk_header->magic, "cxsparse", 8);
57c7d9e5 693
78439f6a
CA
694 /*
695 * Note: The spec is actually wrong here for data_offset, it says
696 * 0xFFFFFFFF, but MS tools expect all 64 bits to be set.
697 */
698 dyndisk_header->data_offset = be64_to_cpu(0xFFFFFFFFFFFFFFFFULL);
57c7d9e5
AL
699 dyndisk_header->table_offset = be64_to_cpu(3 * 512);
700 dyndisk_header->version = be32_to_cpu(0x00010000);
701 dyndisk_header->block_size = be32_to_cpu(block_size);
702 dyndisk_header->max_table_entries = be32_to_cpu(num_bat_entries);
703
704 dyndisk_header->checksum = be32_to_cpu(vpc_checksum(buf, 1024));
705
706 // Write the header
fef6070e 707 offset = 512;
57c7d9e5 708
fef6070e
JC
709 ret = bdrv_pwrite_sync(bs, offset, buf, 1024);
710 if (ret < 0) {
f0ff243a
BS
711 goto fail;
712 }
f0ff243a 713
24da78db
CA
714 fail:
715 return ret;
716}
717
fef6070e
JC
718static int create_fixed_disk(BlockDriverState *bs, uint8_t *buf,
719 int64_t total_size)
24da78db 720{
fef6070e 721 int ret;
24da78db
CA
722
723 /* Add footer to total size */
fef6070e
JC
724 total_size += HEADER_SIZE;
725
726 ret = bdrv_truncate(bs, total_size);
727 if (ret < 0) {
728 return ret;
24da78db
CA
729 }
730
fef6070e
JC
731 ret = bdrv_pwrite_sync(bs, total_size - HEADER_SIZE, buf, HEADER_SIZE);
732 if (ret < 0) {
733 return ret;
734 }
24da78db 735
24da78db
CA
736 return ret;
737}
738
fec9921f 739static int vpc_create(const char *filename, QemuOpts *opts, Error **errp)
24da78db
CA
740{
741 uint8_t buf[1024];
e54835c0 742 VHDFooter *footer = (VHDFooter *) buf;
fec9921f 743 char *disk_type_param;
fef6070e 744 int i;
24da78db
CA
745 uint16_t cyls = 0;
746 uint8_t heads = 0;
747 uint8_t secs_per_cyl = 0;
748 int64_t total_sectors;
749 int64_t total_size;
750 int disk_type;
751 int ret = -EIO;
fef6070e
JC
752 Error *local_err = NULL;
753 BlockDriverState *bs = NULL;
24da78db
CA
754
755 /* Read out options */
fec9921f
CL
756 total_size = qemu_opt_get_size_del(opts, BLOCK_OPT_SIZE, 0);
757 disk_type_param = qemu_opt_get_del(opts, BLOCK_OPT_SUBFMT);
758 if (disk_type_param) {
759 if (!strcmp(disk_type_param, "dynamic")) {
24da78db 760 disk_type = VHD_DYNAMIC;
fec9921f 761 } else if (!strcmp(disk_type_param, "fixed")) {
24da78db
CA
762 disk_type = VHD_FIXED;
763 } else {
fec9921f
CL
764 ret = -EINVAL;
765 goto out;
24da78db
CA
766 }
767 } else {
768 disk_type = VHD_DYNAMIC;
769 }
770
fef6070e
JC
771 ret = bdrv_create_file(filename, opts, &local_err);
772 if (ret < 0) {
773 error_propagate(errp, local_err);
fec9921f 774 goto out;
24da78db 775 }
fef6070e
JC
776 ret = bdrv_open(&bs, filename, NULL, NULL, BDRV_O_RDWR | BDRV_O_PROTOCOL,
777 NULL, &local_err);
778 if (ret < 0) {
779 error_propagate(errp, local_err);
780 goto out;
4ab15590
CL
781 }
782
ecd880d9
KW
783 /*
784 * Calculate matching total_size and geometry. Increase the number of
785 * sectors requested until we get enough (or fail). This ensures that
786 * qemu-img convert doesn't truncate images, but rather rounds up.
787 */
24da78db 788 total_sectors = total_size / BDRV_SECTOR_SIZE;
ecd880d9
KW
789 for (i = 0; total_sectors > (int64_t)cyls * heads * secs_per_cyl; i++) {
790 if (calculate_geometry(total_sectors + i, &cyls, &heads,
791 &secs_per_cyl))
792 {
24da78db 793 ret = -EFBIG;
fef6070e 794 goto out;
24da78db
CA
795 }
796 }
ecd880d9 797
24da78db
CA
798 total_sectors = (int64_t) cyls * heads * secs_per_cyl;
799
800 /* Prepare the Hard Disk Footer */
801 memset(buf, 0, 1024);
802
803 memcpy(footer->creator, "conectix", 8);
804 /* TODO Check if "qemu" creator_app is ok for VPC */
805 memcpy(footer->creator_app, "qemu", 4);
806 memcpy(footer->creator_os, "Wi2k", 4);
807
808 footer->features = be32_to_cpu(0x02);
809 footer->version = be32_to_cpu(0x00010000);
810 if (disk_type == VHD_DYNAMIC) {
811 footer->data_offset = be64_to_cpu(HEADER_SIZE);
812 } else {
813 footer->data_offset = be64_to_cpu(0xFFFFFFFFFFFFFFFFULL);
814 }
815 footer->timestamp = be32_to_cpu(time(NULL) - VHD_TIMESTAMP_BASE);
816
817 /* Version of Virtual PC 2007 */
818 footer->major = be16_to_cpu(0x0005);
819 footer->minor = be16_to_cpu(0x0003);
820 if (disk_type == VHD_DYNAMIC) {
821 footer->orig_size = be64_to_cpu(total_sectors * 512);
822 footer->size = be64_to_cpu(total_sectors * 512);
823 } else {
824 footer->orig_size = be64_to_cpu(total_size);
825 footer->size = be64_to_cpu(total_size);
826 }
827 footer->cyls = be16_to_cpu(cyls);
828 footer->heads = heads;
829 footer->secs_per_cyl = secs_per_cyl;
830
831 footer->type = be32_to_cpu(disk_type);
832
1fe1fa51
CA
833#if defined(CONFIG_UUID)
834 uuid_generate(footer->uuid);
835#endif
24da78db
CA
836
837 footer->checksum = be32_to_cpu(vpc_checksum(buf, HEADER_SIZE));
838
839 if (disk_type == VHD_DYNAMIC) {
fef6070e 840 ret = create_dynamic_disk(bs, buf, total_sectors);
24da78db 841 } else {
fef6070e 842 ret = create_fixed_disk(bs, buf, total_size);
24da78db
CA
843 }
844
fec9921f 845out:
fef6070e 846 bdrv_unref(bs);
fec9921f 847 g_free(disk_type_param);
f0ff243a 848 return ret;
57c7d9e5
AL
849}
850
72c6cc94
KW
851static int vpc_has_zero_init(BlockDriverState *bs)
852{
853 BDRVVPCState *s = bs->opaque;
e54835c0 854 VHDFooter *footer = (VHDFooter *) s->footer_buf;
72c6cc94
KW
855
856 if (cpu_to_be32(footer->type) == VHD_FIXED) {
857 return bdrv_has_zero_init(bs->file);
858 } else {
859 return 1;
860 }
861}
862
6a0f9e82
FB
863static void vpc_close(BlockDriverState *bs)
864{
865 BDRVVPCState *s = bs->opaque;
97f1c45c 866 qemu_vfree(s->pagetable);
6a0f9e82 867#ifdef CACHE
7267c094 868 g_free(s->pageentry_u8);
6a0f9e82 869#endif
612ff3d8
KW
870
871 migrate_del_blocker(s->migration_blocker);
872 error_free(s->migration_blocker);
6a0f9e82
FB
873}
874
fec9921f
CL
875static QemuOptsList vpc_create_opts = {
876 .name = "vpc-create-opts",
877 .head = QTAILQ_HEAD_INITIALIZER(vpc_create_opts.head),
878 .desc = {
879 {
880 .name = BLOCK_OPT_SIZE,
881 .type = QEMU_OPT_SIZE,
882 .help = "Virtual disk size"
883 },
884 {
885 .name = BLOCK_OPT_SUBFMT,
886 .type = QEMU_OPT_STRING,
887 .help =
888 "Type of virtual hard disk format. Supported formats are "
889 "{dynamic (default) | fixed} "
890 },
4ab15590
CL
891 {
892 .name = BLOCK_OPT_NOCOW,
893 .type = QEMU_OPT_BOOL,
894 .help = "Turn off copy-on-write (valid only on btrfs)"
895 },
fec9921f
CL
896 { /* end of list */ }
897 }
0e7e1989
KW
898};
899
5efa9d5a 900static BlockDriver bdrv_vpc = {
4a411185
KW
901 .format_name = "vpc",
902 .instance_size = sizeof(BDRVVPCState),
c68b89ac 903
72c6cc94
KW
904 .bdrv_probe = vpc_probe,
905 .bdrv_open = vpc_open,
906 .bdrv_close = vpc_close,
907 .bdrv_reopen_prepare = vpc_reopen_prepare,
c282e1fd 908 .bdrv_create = vpc_create,
0e7e1989 909
c68b89ac
KW
910 .bdrv_read = vpc_co_read,
911 .bdrv_write = vpc_co_write,
c68b89ac 912
97b00e28
PB
913 .bdrv_get_info = vpc_get_info,
914
fec9921f 915 .create_opts = &vpc_create_opts,
72c6cc94 916 .bdrv_has_zero_init = vpc_has_zero_init,
6a0f9e82 917};
5efa9d5a
AL
918
919static void bdrv_vpc_init(void)
920{
921 bdrv_register(&bdrv_vpc);
922}
923
924block_init(bdrv_vpc_init);