xref: /openbmc/qemu/block/vdi.c (revision 9c4218e9)
1 /*
2  * Block driver for the Virtual Disk Image (VDI) format
3  *
4  * Copyright (c) 2009, 2012 Stefan Weil
5  *
6  * This program is free software: you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation, either version 2 of the License, or
9  * (at your option) version 3 or any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18  *
19  * Reference:
20  * http://forums.virtualbox.org/viewtopic.php?t=8046
21  *
22  * This driver supports create / read / write operations on VDI images.
23  *
24  * Todo (see also TODO in code):
25  *
26  * Some features like snapshots are still missing.
27  *
28  * Deallocation of zero-filled blocks and shrinking images are missing, too
29  * (might be added to common block layer).
30  *
31  * Allocation of blocks could be optimized (less writes to block map and
32  * header).
33  *
34  * Read and write of adjacent blocks could be done in one operation
35  * (current code uses one operation per block (1 MiB).
36  *
37  * The code is not thread safe (missing locks for changes in header and
38  * block table, no problem with current QEMU).
39  *
40  * Hints:
41  *
42  * Blocks (VDI documentation) correspond to clusters (QEMU).
43  * QEMU's backing files could be implemented using VDI snapshot files (TODO).
44  * VDI snapshot files may also contain the complete machine state.
45  * Maybe this machine state can be converted to QEMU PC machine snapshot data.
46  *
47  * The driver keeps a block cache (little endian entries) in memory.
48  * For the standard block size (1 MiB), a 1 TiB disk will use 4 MiB RAM,
49  * so this seems to be reasonable.
50  */
51 
52 #include "qemu/osdep.h"
53 #include "qemu-common.h"
54 #include "block/block_int.h"
55 #include "qemu/module.h"
56 #include "migration/migration.h"
57 #include "qemu/coroutine.h"
58 
59 #if defined(CONFIG_UUID)
60 #include <uuid/uuid.h>
61 #else
62 /* TODO: move uuid emulation to some central place in QEMU. */
63 #include "sysemu/sysemu.h"     /* UUID_FMT */
64 typedef unsigned char uuid_t[16];
65 #endif
66 
67 /* Code configuration options. */
68 
69 /* Enable debug messages. */
70 //~ #define CONFIG_VDI_DEBUG
71 
72 /* Support write operations on VDI images. */
73 #define CONFIG_VDI_WRITE
74 
75 /* Support non-standard block (cluster) size. This is untested.
76  * Maybe it will be needed for very large images.
77  */
78 //~ #define CONFIG_VDI_BLOCK_SIZE
79 
80 /* Support static (fixed, pre-allocated) images. */
81 #define CONFIG_VDI_STATIC_IMAGE
82 
83 /* Command line option for static images. */
84 #define BLOCK_OPT_STATIC "static"
85 
86 #define KiB     1024
87 #define MiB     (KiB * KiB)
88 
89 #define SECTOR_SIZE 512
90 #define DEFAULT_CLUSTER_SIZE (1 * MiB)
91 
92 #if defined(CONFIG_VDI_DEBUG)
93 #define logout(fmt, ...) \
94                 fprintf(stderr, "vdi\t%-24s" fmt, __func__, ##__VA_ARGS__)
95 #else
96 #define logout(fmt, ...) ((void)0)
97 #endif
98 
99 /* Image signature. */
100 #define VDI_SIGNATURE 0xbeda107f
101 
102 /* Image version. */
103 #define VDI_VERSION_1_1 0x00010001
104 
105 /* Image type. */
106 #define VDI_TYPE_DYNAMIC 1
107 #define VDI_TYPE_STATIC  2
108 
109 /* Innotek / SUN images use these strings in header.text:
110  * "<<< innotek VirtualBox Disk Image >>>\n"
111  * "<<< Sun xVM VirtualBox Disk Image >>>\n"
112  * "<<< Sun VirtualBox Disk Image >>>\n"
113  * The value does not matter, so QEMU created images use a different text.
114  */
115 #define VDI_TEXT "<<< QEMU VM Virtual Disk Image >>>\n"
116 
117 /* A never-allocated block; semantically arbitrary content. */
118 #define VDI_UNALLOCATED 0xffffffffU
119 
120 /* A discarded (no longer allocated) block; semantically zero-filled. */
121 #define VDI_DISCARDED   0xfffffffeU
122 
123 #define VDI_IS_ALLOCATED(X) ((X) < VDI_DISCARDED)
124 
125 /* The bmap will take up VDI_BLOCKS_IN_IMAGE_MAX * sizeof(uint32_t) bytes; since
126  * the bmap is read and written in a single operation, its size needs to be
127  * limited to INT_MAX; furthermore, when opening an image, the bmap size is
128  * rounded up to be aligned on BDRV_SECTOR_SIZE.
129  * Therefore this should satisfy the following:
130  * VDI_BLOCKS_IN_IMAGE_MAX * sizeof(uint32_t) + BDRV_SECTOR_SIZE == INT_MAX + 1
131  * (INT_MAX + 1 is the first value not representable as an int)
132  * This guarantees that any value below or equal to the constant will, when
133  * multiplied by sizeof(uint32_t) and rounded up to a BDRV_SECTOR_SIZE boundary,
134  * still be below or equal to INT_MAX. */
135 #define VDI_BLOCKS_IN_IMAGE_MAX \
136     ((unsigned)((INT_MAX + 1u - BDRV_SECTOR_SIZE) / sizeof(uint32_t)))
137 #define VDI_DISK_SIZE_MAX        ((uint64_t)VDI_BLOCKS_IN_IMAGE_MAX * \
138                                   (uint64_t)DEFAULT_CLUSTER_SIZE)
139 
140 #if !defined(CONFIG_UUID)
141 static inline void uuid_generate(uuid_t out)
142 {
143     memset(out, 0, sizeof(uuid_t));
144 }
145 
146 static inline int uuid_is_null(const uuid_t uu)
147 {
148     uuid_t null_uuid = { 0 };
149     return memcmp(uu, null_uuid, sizeof(uuid_t)) == 0;
150 }
151 
152 # if defined(CONFIG_VDI_DEBUG)
153 static inline void uuid_unparse(const uuid_t uu, char *out)
154 {
155     snprintf(out, 37, UUID_FMT,
156             uu[0], uu[1], uu[2], uu[3], uu[4], uu[5], uu[6], uu[7],
157             uu[8], uu[9], uu[10], uu[11], uu[12], uu[13], uu[14], uu[15]);
158 }
159 # endif
160 #endif
161 
162 typedef struct {
163     char text[0x40];
164     uint32_t signature;
165     uint32_t version;
166     uint32_t header_size;
167     uint32_t image_type;
168     uint32_t image_flags;
169     char description[256];
170     uint32_t offset_bmap;
171     uint32_t offset_data;
172     uint32_t cylinders;         /* disk geometry, unused here */
173     uint32_t heads;             /* disk geometry, unused here */
174     uint32_t sectors;           /* disk geometry, unused here */
175     uint32_t sector_size;
176     uint32_t unused1;
177     uint64_t disk_size;
178     uint32_t block_size;
179     uint32_t block_extra;       /* unused here */
180     uint32_t blocks_in_image;
181     uint32_t blocks_allocated;
182     uuid_t uuid_image;
183     uuid_t uuid_last_snap;
184     uuid_t uuid_link;
185     uuid_t uuid_parent;
186     uint64_t unused2[7];
187 } QEMU_PACKED VdiHeader;
188 
189 typedef struct {
190     /* The block map entries are little endian (even in memory). */
191     uint32_t *bmap;
192     /* Size of block (bytes). */
193     uint32_t block_size;
194     /* Size of block (sectors). */
195     uint32_t block_sectors;
196     /* First sector of block map. */
197     uint32_t bmap_sector;
198     /* VDI header (converted to host endianness). */
199     VdiHeader header;
200 
201     CoMutex write_lock;
202 
203     Error *migration_blocker;
204 } BDRVVdiState;
205 
206 /* Change UUID from little endian (IPRT = VirtualBox format) to big endian
207  * format (network byte order, standard, see RFC 4122) and vice versa.
208  */
209 static void uuid_convert(uuid_t uuid)
210 {
211     bswap32s((uint32_t *)&uuid[0]);
212     bswap16s((uint16_t *)&uuid[4]);
213     bswap16s((uint16_t *)&uuid[6]);
214 }
215 
216 static void vdi_header_to_cpu(VdiHeader *header)
217 {
218     le32_to_cpus(&header->signature);
219     le32_to_cpus(&header->version);
220     le32_to_cpus(&header->header_size);
221     le32_to_cpus(&header->image_type);
222     le32_to_cpus(&header->image_flags);
223     le32_to_cpus(&header->offset_bmap);
224     le32_to_cpus(&header->offset_data);
225     le32_to_cpus(&header->cylinders);
226     le32_to_cpus(&header->heads);
227     le32_to_cpus(&header->sectors);
228     le32_to_cpus(&header->sector_size);
229     le64_to_cpus(&header->disk_size);
230     le32_to_cpus(&header->block_size);
231     le32_to_cpus(&header->block_extra);
232     le32_to_cpus(&header->blocks_in_image);
233     le32_to_cpus(&header->blocks_allocated);
234     uuid_convert(header->uuid_image);
235     uuid_convert(header->uuid_last_snap);
236     uuid_convert(header->uuid_link);
237     uuid_convert(header->uuid_parent);
238 }
239 
240 static void vdi_header_to_le(VdiHeader *header)
241 {
242     cpu_to_le32s(&header->signature);
243     cpu_to_le32s(&header->version);
244     cpu_to_le32s(&header->header_size);
245     cpu_to_le32s(&header->image_type);
246     cpu_to_le32s(&header->image_flags);
247     cpu_to_le32s(&header->offset_bmap);
248     cpu_to_le32s(&header->offset_data);
249     cpu_to_le32s(&header->cylinders);
250     cpu_to_le32s(&header->heads);
251     cpu_to_le32s(&header->sectors);
252     cpu_to_le32s(&header->sector_size);
253     cpu_to_le64s(&header->disk_size);
254     cpu_to_le32s(&header->block_size);
255     cpu_to_le32s(&header->block_extra);
256     cpu_to_le32s(&header->blocks_in_image);
257     cpu_to_le32s(&header->blocks_allocated);
258     uuid_convert(header->uuid_image);
259     uuid_convert(header->uuid_last_snap);
260     uuid_convert(header->uuid_link);
261     uuid_convert(header->uuid_parent);
262 }
263 
264 #if defined(CONFIG_VDI_DEBUG)
265 static void vdi_header_print(VdiHeader *header)
266 {
267     char uuid[37];
268     logout("text        %s", header->text);
269     logout("signature   0x%08x\n", header->signature);
270     logout("header size 0x%04x\n", header->header_size);
271     logout("image type  0x%04x\n", header->image_type);
272     logout("image flags 0x%04x\n", header->image_flags);
273     logout("description %s\n", header->description);
274     logout("offset bmap 0x%04x\n", header->offset_bmap);
275     logout("offset data 0x%04x\n", header->offset_data);
276     logout("cylinders   0x%04x\n", header->cylinders);
277     logout("heads       0x%04x\n", header->heads);
278     logout("sectors     0x%04x\n", header->sectors);
279     logout("sector size 0x%04x\n", header->sector_size);
280     logout("image size  0x%" PRIx64 " B (%" PRIu64 " MiB)\n",
281            header->disk_size, header->disk_size / MiB);
282     logout("block size  0x%04x\n", header->block_size);
283     logout("block extra 0x%04x\n", header->block_extra);
284     logout("blocks tot. 0x%04x\n", header->blocks_in_image);
285     logout("blocks all. 0x%04x\n", header->blocks_allocated);
286     uuid_unparse(header->uuid_image, uuid);
287     logout("uuid image  %s\n", uuid);
288     uuid_unparse(header->uuid_last_snap, uuid);
289     logout("uuid snap   %s\n", uuid);
290     uuid_unparse(header->uuid_link, uuid);
291     logout("uuid link   %s\n", uuid);
292     uuid_unparse(header->uuid_parent, uuid);
293     logout("uuid parent %s\n", uuid);
294 }
295 #endif
296 
297 static int vdi_check(BlockDriverState *bs, BdrvCheckResult *res,
298                      BdrvCheckMode fix)
299 {
300     /* TODO: additional checks possible. */
301     BDRVVdiState *s = (BDRVVdiState *)bs->opaque;
302     uint32_t blocks_allocated = 0;
303     uint32_t block;
304     uint32_t *bmap;
305     logout("\n");
306 
307     if (fix) {
308         return -ENOTSUP;
309     }
310 
311     bmap = g_try_new(uint32_t, s->header.blocks_in_image);
312     if (s->header.blocks_in_image && bmap == NULL) {
313         res->check_errors++;
314         return -ENOMEM;
315     }
316 
317     memset(bmap, 0xff, s->header.blocks_in_image * sizeof(uint32_t));
318 
319     /* Check block map and value of blocks_allocated. */
320     for (block = 0; block < s->header.blocks_in_image; block++) {
321         uint32_t bmap_entry = le32_to_cpu(s->bmap[block]);
322         if (VDI_IS_ALLOCATED(bmap_entry)) {
323             if (bmap_entry < s->header.blocks_in_image) {
324                 blocks_allocated++;
325                 if (!VDI_IS_ALLOCATED(bmap[bmap_entry])) {
326                     bmap[bmap_entry] = bmap_entry;
327                 } else {
328                     fprintf(stderr, "ERROR: block index %" PRIu32
329                             " also used by %" PRIu32 "\n", bmap[bmap_entry], bmap_entry);
330                     res->corruptions++;
331                 }
332             } else {
333                 fprintf(stderr, "ERROR: block index %" PRIu32
334                         " too large, is %" PRIu32 "\n", block, bmap_entry);
335                 res->corruptions++;
336             }
337         }
338     }
339     if (blocks_allocated != s->header.blocks_allocated) {
340         fprintf(stderr, "ERROR: allocated blocks mismatch, is %" PRIu32
341                ", should be %" PRIu32 "\n",
342                blocks_allocated, s->header.blocks_allocated);
343         res->corruptions++;
344     }
345 
346     g_free(bmap);
347 
348     return 0;
349 }
350 
351 static int vdi_get_info(BlockDriverState *bs, BlockDriverInfo *bdi)
352 {
353     /* TODO: vdi_get_info would be needed for machine snapshots.
354        vm_state_offset is still missing. */
355     BDRVVdiState *s = (BDRVVdiState *)bs->opaque;
356     logout("\n");
357     bdi->cluster_size = s->block_size;
358     bdi->vm_state_offset = 0;
359     bdi->unallocated_blocks_are_zero = true;
360     return 0;
361 }
362 
363 static int vdi_make_empty(BlockDriverState *bs)
364 {
365     /* TODO: missing code. */
366     logout("\n");
367     /* The return value for missing code must be 0, see block.c. */
368     return 0;
369 }
370 
371 static int vdi_probe(const uint8_t *buf, int buf_size, const char *filename)
372 {
373     const VdiHeader *header = (const VdiHeader *)buf;
374     int ret = 0;
375 
376     logout("\n");
377 
378     if (buf_size < sizeof(*header)) {
379         /* Header too small, no VDI. */
380     } else if (le32_to_cpu(header->signature) == VDI_SIGNATURE) {
381         ret = 100;
382     }
383 
384     if (ret == 0) {
385         logout("no vdi image\n");
386     } else {
387         logout("%s", header->text);
388     }
389 
390     return ret;
391 }
392 
393 static int vdi_open(BlockDriverState *bs, QDict *options, int flags,
394                     Error **errp)
395 {
396     BDRVVdiState *s = bs->opaque;
397     VdiHeader header;
398     size_t bmap_size;
399     int ret;
400 
401     logout("\n");
402 
403     ret = bdrv_read(bs->file->bs, 0, (uint8_t *)&header, 1);
404     if (ret < 0) {
405         goto fail;
406     }
407 
408     vdi_header_to_cpu(&header);
409 #if defined(CONFIG_VDI_DEBUG)
410     vdi_header_print(&header);
411 #endif
412 
413     if (header.disk_size > VDI_DISK_SIZE_MAX) {
414         error_setg(errp, "Unsupported VDI image size (size is 0x%" PRIx64
415                           ", max supported is 0x%" PRIx64 ")",
416                           header.disk_size, VDI_DISK_SIZE_MAX);
417         ret = -ENOTSUP;
418         goto fail;
419     }
420 
421     if (header.disk_size % SECTOR_SIZE != 0) {
422         /* 'VBoxManage convertfromraw' can create images with odd disk sizes.
423            We accept them but round the disk size to the next multiple of
424            SECTOR_SIZE. */
425         logout("odd disk size %" PRIu64 " B, round up\n", header.disk_size);
426         header.disk_size = ROUND_UP(header.disk_size, SECTOR_SIZE);
427     }
428 
429     if (header.signature != VDI_SIGNATURE) {
430         error_setg(errp, "Image not in VDI format (bad signature %08" PRIx32
431                    ")", header.signature);
432         ret = -EINVAL;
433         goto fail;
434     } else if (header.version != VDI_VERSION_1_1) {
435         error_setg(errp, "unsupported VDI image (version %" PRIu32 ".%" PRIu32
436                    ")", header.version >> 16, header.version & 0xffff);
437         ret = -ENOTSUP;
438         goto fail;
439     } else if (header.offset_bmap % SECTOR_SIZE != 0) {
440         /* We only support block maps which start on a sector boundary. */
441         error_setg(errp, "unsupported VDI image (unaligned block map offset "
442                    "0x%" PRIx32 ")", header.offset_bmap);
443         ret = -ENOTSUP;
444         goto fail;
445     } else if (header.offset_data % SECTOR_SIZE != 0) {
446         /* We only support data blocks which start on a sector boundary. */
447         error_setg(errp, "unsupported VDI image (unaligned data offset 0x%"
448                    PRIx32 ")", header.offset_data);
449         ret = -ENOTSUP;
450         goto fail;
451     } else if (header.sector_size != SECTOR_SIZE) {
452         error_setg(errp, "unsupported VDI image (sector size %" PRIu32
453                    " is not %u)", header.sector_size, SECTOR_SIZE);
454         ret = -ENOTSUP;
455         goto fail;
456     } else if (header.block_size != DEFAULT_CLUSTER_SIZE) {
457         error_setg(errp, "unsupported VDI image (block size %" PRIu32
458                    " is not %u)", header.block_size, DEFAULT_CLUSTER_SIZE);
459         ret = -ENOTSUP;
460         goto fail;
461     } else if (header.disk_size >
462                (uint64_t)header.blocks_in_image * header.block_size) {
463         error_setg(errp, "unsupported VDI image (disk size %" PRIu64 ", "
464                    "image bitmap has room for %" PRIu64 ")",
465                    header.disk_size,
466                    (uint64_t)header.blocks_in_image * header.block_size);
467         ret = -ENOTSUP;
468         goto fail;
469     } else if (!uuid_is_null(header.uuid_link)) {
470         error_setg(errp, "unsupported VDI image (non-NULL link UUID)");
471         ret = -ENOTSUP;
472         goto fail;
473     } else if (!uuid_is_null(header.uuid_parent)) {
474         error_setg(errp, "unsupported VDI image (non-NULL parent UUID)");
475         ret = -ENOTSUP;
476         goto fail;
477     } else if (header.blocks_in_image > VDI_BLOCKS_IN_IMAGE_MAX) {
478         error_setg(errp, "unsupported VDI image "
479                          "(too many blocks %u, max is %u)",
480                           header.blocks_in_image, VDI_BLOCKS_IN_IMAGE_MAX);
481         ret = -ENOTSUP;
482         goto fail;
483     }
484 
485     bs->total_sectors = header.disk_size / SECTOR_SIZE;
486 
487     s->block_size = header.block_size;
488     s->block_sectors = header.block_size / SECTOR_SIZE;
489     s->bmap_sector = header.offset_bmap / SECTOR_SIZE;
490     s->header = header;
491 
492     bmap_size = header.blocks_in_image * sizeof(uint32_t);
493     bmap_size = DIV_ROUND_UP(bmap_size, SECTOR_SIZE);
494     s->bmap = qemu_try_blockalign(bs->file->bs, bmap_size * SECTOR_SIZE);
495     if (s->bmap == NULL) {
496         ret = -ENOMEM;
497         goto fail;
498     }
499 
500     ret = bdrv_read(bs->file->bs, s->bmap_sector, (uint8_t *)s->bmap,
501                     bmap_size);
502     if (ret < 0) {
503         goto fail_free_bmap;
504     }
505 
506     /* Disable migration when vdi images are used */
507     error_setg(&s->migration_blocker, "The vdi format used by node '%s' "
508                "does not support live migration",
509                bdrv_get_device_or_node_name(bs));
510     migrate_add_blocker(s->migration_blocker);
511 
512     qemu_co_mutex_init(&s->write_lock);
513 
514     return 0;
515 
516  fail_free_bmap:
517     qemu_vfree(s->bmap);
518 
519  fail:
520     return ret;
521 }
522 
523 static int vdi_reopen_prepare(BDRVReopenState *state,
524                               BlockReopenQueue *queue, Error **errp)
525 {
526     return 0;
527 }
528 
529 static int64_t coroutine_fn vdi_co_get_block_status(BlockDriverState *bs,
530         int64_t sector_num, int nb_sectors, int *pnum)
531 {
532     /* TODO: Check for too large sector_num (in bdrv_is_allocated or here). */
533     BDRVVdiState *s = (BDRVVdiState *)bs->opaque;
534     size_t bmap_index = sector_num / s->block_sectors;
535     size_t sector_in_block = sector_num % s->block_sectors;
536     int n_sectors = s->block_sectors - sector_in_block;
537     uint32_t bmap_entry = le32_to_cpu(s->bmap[bmap_index]);
538     uint64_t offset;
539     int result;
540 
541     logout("%p, %" PRId64 ", %d, %p\n", bs, sector_num, nb_sectors, pnum);
542     if (n_sectors > nb_sectors) {
543         n_sectors = nb_sectors;
544     }
545     *pnum = n_sectors;
546     result = VDI_IS_ALLOCATED(bmap_entry);
547     if (!result) {
548         return 0;
549     }
550 
551     offset = s->header.offset_data +
552                               (uint64_t)bmap_entry * s->block_size +
553                               sector_in_block * SECTOR_SIZE;
554     return BDRV_BLOCK_DATA | BDRV_BLOCK_OFFSET_VALID | offset;
555 }
556 
557 static int vdi_co_read(BlockDriverState *bs,
558         int64_t sector_num, uint8_t *buf, int nb_sectors)
559 {
560     BDRVVdiState *s = bs->opaque;
561     uint32_t bmap_entry;
562     uint32_t block_index;
563     uint32_t sector_in_block;
564     uint32_t n_sectors;
565     int ret = 0;
566 
567     logout("\n");
568 
569     while (ret >= 0 && nb_sectors > 0) {
570         block_index = sector_num / s->block_sectors;
571         sector_in_block = sector_num % s->block_sectors;
572         n_sectors = s->block_sectors - sector_in_block;
573         if (n_sectors > nb_sectors) {
574             n_sectors = nb_sectors;
575         }
576 
577         logout("will read %u sectors starting at sector %" PRIu64 "\n",
578                n_sectors, sector_num);
579 
580         /* prepare next AIO request */
581         bmap_entry = le32_to_cpu(s->bmap[block_index]);
582         if (!VDI_IS_ALLOCATED(bmap_entry)) {
583             /* Block not allocated, return zeros, no need to wait. */
584             memset(buf, 0, n_sectors * SECTOR_SIZE);
585             ret = 0;
586         } else {
587             uint64_t offset = s->header.offset_data / SECTOR_SIZE +
588                               (uint64_t)bmap_entry * s->block_sectors +
589                               sector_in_block;
590             ret = bdrv_read(bs->file->bs, offset, buf, n_sectors);
591         }
592         logout("%u sectors read\n", n_sectors);
593 
594         nb_sectors -= n_sectors;
595         sector_num += n_sectors;
596         buf += n_sectors * SECTOR_SIZE;
597     }
598 
599     return ret;
600 }
601 
602 static int vdi_co_write(BlockDriverState *bs,
603         int64_t sector_num, const uint8_t *buf, int nb_sectors)
604 {
605     BDRVVdiState *s = bs->opaque;
606     uint32_t bmap_entry;
607     uint32_t block_index;
608     uint32_t sector_in_block;
609     uint32_t n_sectors;
610     uint32_t bmap_first = VDI_UNALLOCATED;
611     uint32_t bmap_last = VDI_UNALLOCATED;
612     uint8_t *block = NULL;
613     int ret = 0;
614 
615     logout("\n");
616 
617     while (ret >= 0 && nb_sectors > 0) {
618         block_index = sector_num / s->block_sectors;
619         sector_in_block = sector_num % s->block_sectors;
620         n_sectors = s->block_sectors - sector_in_block;
621         if (n_sectors > nb_sectors) {
622             n_sectors = nb_sectors;
623         }
624 
625         logout("will write %u sectors starting at sector %" PRIu64 "\n",
626                n_sectors, sector_num);
627 
628         /* prepare next AIO request */
629         bmap_entry = le32_to_cpu(s->bmap[block_index]);
630         if (!VDI_IS_ALLOCATED(bmap_entry)) {
631             /* Allocate new block and write to it. */
632             uint64_t offset;
633             bmap_entry = s->header.blocks_allocated;
634             s->bmap[block_index] = cpu_to_le32(bmap_entry);
635             s->header.blocks_allocated++;
636             offset = s->header.offset_data / SECTOR_SIZE +
637                      (uint64_t)bmap_entry * s->block_sectors;
638             if (block == NULL) {
639                 block = g_malloc(s->block_size);
640                 bmap_first = block_index;
641             }
642             bmap_last = block_index;
643             /* Copy data to be written to new block and zero unused parts. */
644             memset(block, 0, sector_in_block * SECTOR_SIZE);
645             memcpy(block + sector_in_block * SECTOR_SIZE,
646                    buf, n_sectors * SECTOR_SIZE);
647             memset(block + (sector_in_block + n_sectors) * SECTOR_SIZE, 0,
648                    (s->block_sectors - n_sectors - sector_in_block) * SECTOR_SIZE);
649 
650             /* Note that this coroutine does not yield anywhere from reading the
651              * bmap entry until here, so in regards to all the coroutines trying
652              * to write to this cluster, the one doing the allocation will
653              * always be the first to try to acquire the lock.
654              * Therefore, it is also the first that will actually be able to
655              * acquire the lock and thus the padded cluster is written before
656              * the other coroutines can write to the affected area. */
657             qemu_co_mutex_lock(&s->write_lock);
658             ret = bdrv_write(bs->file->bs, offset, block, s->block_sectors);
659             qemu_co_mutex_unlock(&s->write_lock);
660         } else {
661             uint64_t offset = s->header.offset_data / SECTOR_SIZE +
662                               (uint64_t)bmap_entry * s->block_sectors +
663                               sector_in_block;
664             qemu_co_mutex_lock(&s->write_lock);
665             /* This lock is only used to make sure the following write operation
666              * is executed after the write issued by the coroutine allocating
667              * this cluster, therefore we do not need to keep it locked.
668              * As stated above, the allocating coroutine will always try to lock
669              * the mutex before all the other concurrent accesses to that
670              * cluster, therefore at this point we can be absolutely certain
671              * that that write operation has returned (there may be other writes
672              * in flight, but they do not concern this very operation). */
673             qemu_co_mutex_unlock(&s->write_lock);
674             ret = bdrv_write(bs->file->bs, offset, buf, n_sectors);
675         }
676 
677         nb_sectors -= n_sectors;
678         sector_num += n_sectors;
679         buf += n_sectors * SECTOR_SIZE;
680 
681         logout("%u sectors written\n", n_sectors);
682     }
683 
684     logout("finished data write\n");
685     if (ret < 0) {
686         return ret;
687     }
688 
689     if (block) {
690         /* One or more new blocks were allocated. */
691         VdiHeader *header = (VdiHeader *) block;
692         uint8_t *base;
693         uint64_t offset;
694 
695         logout("now writing modified header\n");
696         assert(VDI_IS_ALLOCATED(bmap_first));
697         *header = s->header;
698         vdi_header_to_le(header);
699         ret = bdrv_write(bs->file->bs, 0, block, 1);
700         g_free(block);
701         block = NULL;
702 
703         if (ret < 0) {
704             return ret;
705         }
706 
707         logout("now writing modified block map entry %u...%u\n",
708                bmap_first, bmap_last);
709         /* Write modified sectors from block map. */
710         bmap_first /= (SECTOR_SIZE / sizeof(uint32_t));
711         bmap_last /= (SECTOR_SIZE / sizeof(uint32_t));
712         n_sectors = bmap_last - bmap_first + 1;
713         offset = s->bmap_sector + bmap_first;
714         base = ((uint8_t *)&s->bmap[0]) + bmap_first * SECTOR_SIZE;
715         logout("will write %u block map sectors starting from entry %u\n",
716                n_sectors, bmap_first);
717         ret = bdrv_write(bs->file->bs, offset, base, n_sectors);
718     }
719 
720     return ret;
721 }
722 
723 static int vdi_create(const char *filename, QemuOpts *opts, Error **errp)
724 {
725     int ret = 0;
726     uint64_t bytes = 0;
727     uint32_t blocks;
728     size_t block_size = DEFAULT_CLUSTER_SIZE;
729     uint32_t image_type = VDI_TYPE_DYNAMIC;
730     VdiHeader header;
731     size_t i;
732     size_t bmap_size;
733     int64_t offset = 0;
734     Error *local_err = NULL;
735     BlockDriverState *bs = NULL;
736     uint32_t *bmap = NULL;
737 
738     logout("\n");
739 
740     /* Read out options. */
741     bytes = ROUND_UP(qemu_opt_get_size_del(opts, BLOCK_OPT_SIZE, 0),
742                      BDRV_SECTOR_SIZE);
743 #if defined(CONFIG_VDI_BLOCK_SIZE)
744     /* TODO: Additional checks (SECTOR_SIZE * 2^n, ...). */
745     block_size = qemu_opt_get_size_del(opts,
746                                        BLOCK_OPT_CLUSTER_SIZE,
747                                        DEFAULT_CLUSTER_SIZE);
748 #endif
749 #if defined(CONFIG_VDI_STATIC_IMAGE)
750     if (qemu_opt_get_bool_del(opts, BLOCK_OPT_STATIC, false)) {
751         image_type = VDI_TYPE_STATIC;
752     }
753 #endif
754 
755     if (bytes > VDI_DISK_SIZE_MAX) {
756         ret = -ENOTSUP;
757         error_setg(errp, "Unsupported VDI image size (size is 0x%" PRIx64
758                           ", max supported is 0x%" PRIx64 ")",
759                           bytes, VDI_DISK_SIZE_MAX);
760         goto exit;
761     }
762 
763     ret = bdrv_create_file(filename, opts, &local_err);
764     if (ret < 0) {
765         error_propagate(errp, local_err);
766         goto exit;
767     }
768     ret = bdrv_open(&bs, filename, NULL, NULL, BDRV_O_RDWR | BDRV_O_PROTOCOL,
769                     &local_err);
770     if (ret < 0) {
771         error_propagate(errp, local_err);
772         goto exit;
773     }
774 
775     /* We need enough blocks to store the given disk size,
776        so always round up. */
777     blocks = DIV_ROUND_UP(bytes, block_size);
778 
779     bmap_size = blocks * sizeof(uint32_t);
780     bmap_size = ROUND_UP(bmap_size, SECTOR_SIZE);
781 
782     memset(&header, 0, sizeof(header));
783     pstrcpy(header.text, sizeof(header.text), VDI_TEXT);
784     header.signature = VDI_SIGNATURE;
785     header.version = VDI_VERSION_1_1;
786     header.header_size = 0x180;
787     header.image_type = image_type;
788     header.offset_bmap = 0x200;
789     header.offset_data = 0x200 + bmap_size;
790     header.sector_size = SECTOR_SIZE;
791     header.disk_size = bytes;
792     header.block_size = block_size;
793     header.blocks_in_image = blocks;
794     if (image_type == VDI_TYPE_STATIC) {
795         header.blocks_allocated = blocks;
796     }
797     uuid_generate(header.uuid_image);
798     uuid_generate(header.uuid_last_snap);
799     /* There is no need to set header.uuid_link or header.uuid_parent here. */
800 #if defined(CONFIG_VDI_DEBUG)
801     vdi_header_print(&header);
802 #endif
803     vdi_header_to_le(&header);
804     ret = bdrv_pwrite_sync(bs, offset, &header, sizeof(header));
805     if (ret < 0) {
806         error_setg(errp, "Error writing header to %s", filename);
807         goto exit;
808     }
809     offset += sizeof(header);
810 
811     if (bmap_size > 0) {
812         bmap = g_try_malloc0(bmap_size);
813         if (bmap == NULL) {
814             ret = -ENOMEM;
815             error_setg(errp, "Could not allocate bmap");
816             goto exit;
817         }
818         for (i = 0; i < blocks; i++) {
819             if (image_type == VDI_TYPE_STATIC) {
820                 bmap[i] = i;
821             } else {
822                 bmap[i] = VDI_UNALLOCATED;
823             }
824         }
825         ret = bdrv_pwrite_sync(bs, offset, bmap, bmap_size);
826         if (ret < 0) {
827             error_setg(errp, "Error writing bmap to %s", filename);
828             goto exit;
829         }
830         offset += bmap_size;
831     }
832 
833     if (image_type == VDI_TYPE_STATIC) {
834         ret = bdrv_truncate(bs, offset + blocks * block_size);
835         if (ret < 0) {
836             error_setg(errp, "Failed to statically allocate %s", filename);
837             goto exit;
838         }
839     }
840 
841 exit:
842     bdrv_unref(bs);
843     g_free(bmap);
844     return ret;
845 }
846 
847 static void vdi_close(BlockDriverState *bs)
848 {
849     BDRVVdiState *s = bs->opaque;
850 
851     qemu_vfree(s->bmap);
852 
853     migrate_del_blocker(s->migration_blocker);
854     error_free(s->migration_blocker);
855 }
856 
857 static QemuOptsList vdi_create_opts = {
858     .name = "vdi-create-opts",
859     .head = QTAILQ_HEAD_INITIALIZER(vdi_create_opts.head),
860     .desc = {
861         {
862             .name = BLOCK_OPT_SIZE,
863             .type = QEMU_OPT_SIZE,
864             .help = "Virtual disk size"
865         },
866 #if defined(CONFIG_VDI_BLOCK_SIZE)
867         {
868             .name = BLOCK_OPT_CLUSTER_SIZE,
869             .type = QEMU_OPT_SIZE,
870             .help = "VDI cluster (block) size",
871             .def_value_str = stringify(DEFAULT_CLUSTER_SIZE)
872         },
873 #endif
874 #if defined(CONFIG_VDI_STATIC_IMAGE)
875         {
876             .name = BLOCK_OPT_STATIC,
877             .type = QEMU_OPT_BOOL,
878             .help = "VDI static (pre-allocated) image",
879             .def_value_str = "off"
880         },
881 #endif
882         /* TODO: An additional option to set UUID values might be useful. */
883         { /* end of list */ }
884     }
885 };
886 
887 static BlockDriver bdrv_vdi = {
888     .format_name = "vdi",
889     .instance_size = sizeof(BDRVVdiState),
890     .bdrv_probe = vdi_probe,
891     .bdrv_open = vdi_open,
892     .bdrv_close = vdi_close,
893     .bdrv_reopen_prepare = vdi_reopen_prepare,
894     .bdrv_create = vdi_create,
895     .bdrv_has_zero_init = bdrv_has_zero_init_1,
896     .bdrv_co_get_block_status = vdi_co_get_block_status,
897     .bdrv_make_empty = vdi_make_empty,
898 
899     .bdrv_read = vdi_co_read,
900 #if defined(CONFIG_VDI_WRITE)
901     .bdrv_write = vdi_co_write,
902 #endif
903 
904     .bdrv_get_info = vdi_get_info,
905 
906     .create_opts = &vdi_create_opts,
907     .bdrv_check = vdi_check,
908 };
909 
910 static void bdrv_vdi_init(void)
911 {
912     logout("\n");
913     bdrv_register(&bdrv_vdi);
914 }
915 
916 block_init(bdrv_vdi_init);
917