root / block / vpc.c @ 6c6ea921
History | View | Annotate | Download (17.8 kB)
1 | 6a0f9e82 | bellard | /*
|
---|---|---|---|
2 | cc2040f8 | Stefan Weil | * Block driver for Connectix / Microsoft Virtual PC images
|
3 | 5fafdf24 | ths | *
|
4 | 6a0f9e82 | bellard | * Copyright (c) 2005 Alex Beregszaszi
|
5 | 15d35bc5 | aliguori | * Copyright (c) 2009 Kevin Wolf <kwolf@suse.de>
|
6 | 5fafdf24 | ths | *
|
7 | 6a0f9e82 | bellard | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
8 | 6a0f9e82 | bellard | * of this software and associated documentation files (the "Software"), to deal
|
9 | 6a0f9e82 | bellard | * in the Software without restriction, including without limitation the rights
|
10 | 6a0f9e82 | bellard | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
11 | 6a0f9e82 | bellard | * copies of the Software, and to permit persons to whom the Software is
|
12 | 6a0f9e82 | bellard | * furnished to do so, subject to the following conditions:
|
13 | 6a0f9e82 | bellard | *
|
14 | 6a0f9e82 | bellard | * The above copyright notice and this permission notice shall be included in
|
15 | 6a0f9e82 | bellard | * all copies or substantial portions of the Software.
|
16 | 6a0f9e82 | bellard | *
|
17 | 6a0f9e82 | bellard | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
18 | 6a0f9e82 | bellard | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
19 | 6a0f9e82 | bellard | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
20 | 6a0f9e82 | bellard | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
21 | 6a0f9e82 | bellard | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
22 | 6a0f9e82 | bellard | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
23 | 6a0f9e82 | bellard | * THE SOFTWARE.
|
24 | 6a0f9e82 | bellard | */
|
25 | faf07963 | pbrook | #include "qemu-common.h" |
26 | 6a0f9e82 | bellard | #include "block_int.h" |
27 | 5efa9d5a | Anthony Liguori | #include "module.h" |
28 | 6a0f9e82 | bellard | |
29 | 6a0f9e82 | bellard | /**************************************************************/
|
30 | 6a0f9e82 | bellard | |
31 | 6a0f9e82 | bellard | #define HEADER_SIZE 512 |
32 | 6a0f9e82 | bellard | |
33 | 6a0f9e82 | bellard | //#define CACHE
|
34 | 6a0f9e82 | bellard | |
35 | 2cfacb62 | aliguori | enum vhd_type {
|
36 | 2cfacb62 | aliguori | VHD_FIXED = 2,
|
37 | 2cfacb62 | aliguori | VHD_DYNAMIC = 3,
|
38 | 2cfacb62 | aliguori | VHD_DIFFERENCING = 4,
|
39 | 2cfacb62 | aliguori | }; |
40 | 2cfacb62 | aliguori | |
41 | 57c7d9e5 | aliguori | // Seconds since Jan 1, 2000 0:00:00 (UTC)
|
42 | 57c7d9e5 | aliguori | #define VHD_TIMESTAMP_BASE 946684800 |
43 | 57c7d9e5 | aliguori | |
44 | 6a0f9e82 | bellard | // always big-endian
|
45 | b9fa33a6 | aliguori | struct vhd_footer {
|
46 | 2cfacb62 | aliguori | char creator[8]; // "conectix" |
47 | 2cfacb62 | aliguori | uint32_t features; |
48 | 2cfacb62 | aliguori | uint32_t version; |
49 | 2cfacb62 | aliguori | |
50 | 2cfacb62 | aliguori | // Offset of next header structure, 0xFFFFFFFF if none
|
51 | 2cfacb62 | aliguori | uint64_t data_offset; |
52 | 2cfacb62 | aliguori | |
53 | 2cfacb62 | aliguori | // Seconds since Jan 1, 2000 0:00:00 (UTC)
|
54 | 2cfacb62 | aliguori | uint32_t timestamp; |
55 | 2cfacb62 | aliguori | |
56 | 2cfacb62 | aliguori | char creator_app[4]; // "vpc " |
57 | 2cfacb62 | aliguori | uint16_t major; |
58 | 2cfacb62 | aliguori | uint16_t minor; |
59 | 2cfacb62 | aliguori | char creator_os[4]; // "Wi2k" |
60 | 2cfacb62 | aliguori | |
61 | 2cfacb62 | aliguori | uint64_t orig_size; |
62 | 2cfacb62 | aliguori | uint64_t size; |
63 | 2cfacb62 | aliguori | |
64 | 2cfacb62 | aliguori | uint16_t cyls; |
65 | 2cfacb62 | aliguori | uint8_t heads; |
66 | 2cfacb62 | aliguori | uint8_t secs_per_cyl; |
67 | 2cfacb62 | aliguori | |
68 | 2cfacb62 | aliguori | uint32_t type; |
69 | 2cfacb62 | aliguori | |
70 | 2cfacb62 | aliguori | // Checksum of the Hard Disk Footer ("one's complement of the sum of all
|
71 | 2cfacb62 | aliguori | // the bytes in the footer without the checksum field")
|
72 | 2cfacb62 | aliguori | uint32_t checksum; |
73 | 2cfacb62 | aliguori | |
74 | 2cfacb62 | aliguori | // UUID used to identify a parent hard disk (backing file)
|
75 | 2cfacb62 | aliguori | uint8_t uuid[16];
|
76 | 2cfacb62 | aliguori | |
77 | 2cfacb62 | aliguori | uint8_t in_saved_state; |
78 | b9fa33a6 | aliguori | }; |
79 | b9fa33a6 | aliguori | |
80 | b9fa33a6 | aliguori | struct vhd_dyndisk_header {
|
81 | 2cfacb62 | aliguori | char magic[8]; // "cxsparse" |
82 | 2cfacb62 | aliguori | |
83 | 2cfacb62 | aliguori | // Offset of next header structure, 0xFFFFFFFF if none
|
84 | 2cfacb62 | aliguori | uint64_t data_offset; |
85 | 2cfacb62 | aliguori | |
86 | 2cfacb62 | aliguori | // Offset of the Block Allocation Table (BAT)
|
87 | 2cfacb62 | aliguori | uint64_t table_offset; |
88 | 2cfacb62 | aliguori | |
89 | 2cfacb62 | aliguori | uint32_t version; |
90 | 2cfacb62 | aliguori | uint32_t max_table_entries; // 32bit/entry
|
91 | 2cfacb62 | aliguori | |
92 | 2cfacb62 | aliguori | // 2 MB by default, must be a power of two
|
93 | 2cfacb62 | aliguori | uint32_t block_size; |
94 | 2cfacb62 | aliguori | |
95 | 2cfacb62 | aliguori | uint32_t checksum; |
96 | 2cfacb62 | aliguori | uint8_t parent_uuid[16];
|
97 | 2cfacb62 | aliguori | uint32_t parent_timestamp; |
98 | 2cfacb62 | aliguori | uint32_t reserved; |
99 | 2cfacb62 | aliguori | |
100 | 2cfacb62 | aliguori | // Backing file name (in UTF-16)
|
101 | 2cfacb62 | aliguori | uint8_t parent_name[512];
|
102 | 2cfacb62 | aliguori | |
103 | 2cfacb62 | aliguori | struct {
|
104 | 2cfacb62 | aliguori | uint32_t platform; |
105 | 2cfacb62 | aliguori | uint32_t data_space; |
106 | 2cfacb62 | aliguori | uint32_t data_length; |
107 | 2cfacb62 | aliguori | uint32_t reserved; |
108 | 2cfacb62 | aliguori | uint64_t data_offset; |
109 | 2cfacb62 | aliguori | } parent_locator[8];
|
110 | 6a0f9e82 | bellard | }; |
111 | 6a0f9e82 | bellard | |
112 | 6a0f9e82 | bellard | typedef struct BDRVVPCState { |
113 | b71d1c2e | aliguori | BlockDriverState *hd; |
114 | 3b46e624 | ths | |
115 | 15d35bc5 | aliguori | uint8_t footer_buf[HEADER_SIZE]; |
116 | 15d35bc5 | aliguori | uint64_t free_data_block_offset; |
117 | 2cfacb62 | aliguori | int max_table_entries;
|
118 | 6a0f9e82 | bellard | uint32_t *pagetable; |
119 | 15d35bc5 | aliguori | uint64_t bat_offset; |
120 | 15d35bc5 | aliguori | uint64_t last_bitmap_offset; |
121 | 6a0f9e82 | bellard | |
122 | 2cfacb62 | aliguori | uint32_t block_size; |
123 | 15d35bc5 | aliguori | uint32_t bitmap_size; |
124 | 15d35bc5 | aliguori | |
125 | 6a0f9e82 | bellard | #ifdef CACHE
|
126 | 6a0f9e82 | bellard | uint8_t *pageentry_u8; |
127 | 6a0f9e82 | bellard | uint32_t *pageentry_u32; |
128 | 6a0f9e82 | bellard | uint16_t *pageentry_u16; |
129 | 3b46e624 | ths | |
130 | 6a0f9e82 | bellard | uint64_t last_bitmap; |
131 | 6a0f9e82 | bellard | #endif
|
132 | 6a0f9e82 | bellard | } BDRVVPCState; |
133 | 6a0f9e82 | bellard | |
134 | 57c7d9e5 | aliguori | static uint32_t vpc_checksum(uint8_t* buf, size_t size)
|
135 | 57c7d9e5 | aliguori | { |
136 | 57c7d9e5 | aliguori | uint32_t res = 0;
|
137 | 57c7d9e5 | aliguori | int i;
|
138 | 57c7d9e5 | aliguori | |
139 | 57c7d9e5 | aliguori | for (i = 0; i < size; i++) |
140 | 57c7d9e5 | aliguori | res += buf[i]; |
141 | 57c7d9e5 | aliguori | |
142 | 57c7d9e5 | aliguori | return ~res;
|
143 | 57c7d9e5 | aliguori | } |
144 | 57c7d9e5 | aliguori | |
145 | 57c7d9e5 | aliguori | |
146 | 6a0f9e82 | bellard | static int vpc_probe(const uint8_t *buf, int buf_size, const char *filename) |
147 | 6a0f9e82 | bellard | { |
148 | ffe8ab83 | ths | if (buf_size >= 8 && !strncmp((char *)buf, "conectix", 8)) |
149 | 6a0f9e82 | bellard | return 100; |
150 | 6a0f9e82 | bellard | return 0; |
151 | 6a0f9e82 | bellard | } |
152 | 6a0f9e82 | bellard | |
153 | 66f82cee | Kevin Wolf | static int vpc_open(BlockDriverState *bs, int flags) |
154 | 6a0f9e82 | bellard | { |
155 | 6a0f9e82 | bellard | BDRVVPCState *s = bs->opaque; |
156 | 66f82cee | Kevin Wolf | int i;
|
157 | b9fa33a6 | aliguori | struct vhd_footer* footer;
|
158 | b9fa33a6 | aliguori | struct vhd_dyndisk_header* dyndisk_header;
|
159 | b9fa33a6 | aliguori | uint8_t buf[HEADER_SIZE]; |
160 | 57c7d9e5 | aliguori | uint32_t checksum; |
161 | 6a0f9e82 | bellard | |
162 | 66f82cee | Kevin Wolf | if (bdrv_pread(bs->file, 0, s->footer_buf, HEADER_SIZE) != HEADER_SIZE) |
163 | 6a0f9e82 | bellard | goto fail;
|
164 | 6a0f9e82 | bellard | |
165 | 15d35bc5 | aliguori | footer = (struct vhd_footer*) s->footer_buf;
|
166 | b9fa33a6 | aliguori | if (strncmp(footer->creator, "conectix", 8)) |
167 | 6a0f9e82 | bellard | goto fail;
|
168 | 6a0f9e82 | bellard | |
169 | 57c7d9e5 | aliguori | checksum = be32_to_cpu(footer->checksum); |
170 | 57c7d9e5 | aliguori | footer->checksum = 0;
|
171 | 57c7d9e5 | aliguori | if (vpc_checksum(s->footer_buf, HEADER_SIZE) != checksum)
|
172 | 57c7d9e5 | aliguori | fprintf(stderr, "block-vpc: The header checksum of '%s' is "
|
173 | 66f82cee | Kevin Wolf | "incorrect.\n", bs->filename);
|
174 | 57c7d9e5 | aliguori | |
175 | 1fa79228 | aliguori | // The visible size of a image in Virtual PC depends on the geometry
|
176 | 1fa79228 | aliguori | // rather than on the size stored in the footer (the size in the footer
|
177 | 1fa79228 | aliguori | // is too large usually)
|
178 | 1fa79228 | aliguori | bs->total_sectors = (int64_t) |
179 | 1fa79228 | aliguori | be16_to_cpu(footer->cyls) * footer->heads * footer->secs_per_cyl; |
180 | 1fa79228 | aliguori | |
181 | 66f82cee | Kevin Wolf | if (bdrv_pread(bs->file, be64_to_cpu(footer->data_offset), buf, HEADER_SIZE)
|
182 | b71d1c2e | aliguori | != HEADER_SIZE) |
183 | 6a0f9e82 | bellard | goto fail;
|
184 | 6a0f9e82 | bellard | |
185 | b9fa33a6 | aliguori | dyndisk_header = (struct vhd_dyndisk_header*) buf;
|
186 | b9fa33a6 | aliguori | |
187 | b9fa33a6 | aliguori | if (strncmp(dyndisk_header->magic, "cxsparse", 8)) |
188 | b9fa33a6 | aliguori | goto fail;
|
189 | 6a0f9e82 | bellard | |
190 | 6a0f9e82 | bellard | |
191 | 15d35bc5 | aliguori | s->block_size = be32_to_cpu(dyndisk_header->block_size); |
192 | 15d35bc5 | aliguori | s->bitmap_size = ((s->block_size / (8 * 512)) + 511) & ~511; |
193 | 15d35bc5 | aliguori | |
194 | 2cfacb62 | aliguori | s->max_table_entries = be32_to_cpu(dyndisk_header->max_table_entries); |
195 | 2cfacb62 | aliguori | s->pagetable = qemu_malloc(s->max_table_entries * 4);
|
196 | b71d1c2e | aliguori | |
197 | 15d35bc5 | aliguori | s->bat_offset = be64_to_cpu(dyndisk_header->table_offset); |
198 | 66f82cee | Kevin Wolf | if (bdrv_pread(bs->file, s->bat_offset, s->pagetable,
|
199 | 15d35bc5 | aliguori | s->max_table_entries * 4) != s->max_table_entries * 4) |
200 | b71d1c2e | aliguori | goto fail;
|
201 | b71d1c2e | aliguori | |
202 | 15d35bc5 | aliguori | s->free_data_block_offset = |
203 | 15d35bc5 | aliguori | (s->bat_offset + (s->max_table_entries * 4) + 511) & ~511; |
204 | 15d35bc5 | aliguori | |
205 | 15d35bc5 | aliguori | for (i = 0; i < s->max_table_entries; i++) { |
206 | 15d35bc5 | aliguori | be32_to_cpus(&s->pagetable[i]); |
207 | 15d35bc5 | aliguori | if (s->pagetable[i] != 0xFFFFFFFF) { |
208 | 15d35bc5 | aliguori | int64_t next = (512 * (int64_t) s->pagetable[i]) +
|
209 | 15d35bc5 | aliguori | s->bitmap_size + s->block_size; |
210 | 15d35bc5 | aliguori | |
211 | 15d35bc5 | aliguori | if (next> s->free_data_block_offset)
|
212 | 15d35bc5 | aliguori | s->free_data_block_offset = next; |
213 | 15d35bc5 | aliguori | } |
214 | 15d35bc5 | aliguori | } |
215 | 15d35bc5 | aliguori | |
216 | 15d35bc5 | aliguori | s->last_bitmap_offset = (int64_t) -1;
|
217 | 6a0f9e82 | bellard | |
218 | 6a0f9e82 | bellard | #ifdef CACHE
|
219 | 6a0f9e82 | bellard | s->pageentry_u8 = qemu_malloc(512);
|
220 | 6a0f9e82 | bellard | s->pageentry_u32 = s->pageentry_u8; |
221 | 6a0f9e82 | bellard | s->pageentry_u16 = s->pageentry_u8; |
222 | 6a0f9e82 | bellard | s->last_pagetable = -1;
|
223 | 6a0f9e82 | bellard | #endif
|
224 | 6a0f9e82 | bellard | |
225 | 6a0f9e82 | bellard | return 0; |
226 | 6a0f9e82 | bellard | fail:
|
227 | 6a0f9e82 | bellard | return -1; |
228 | 6a0f9e82 | bellard | } |
229 | 6a0f9e82 | bellard | |
230 | b71d1c2e | aliguori | /*
|
231 | b71d1c2e | aliguori | * Returns the absolute byte offset of the given sector in the image file.
|
232 | b71d1c2e | aliguori | * If the sector is not allocated, -1 is returned instead.
|
233 | 15d35bc5 | aliguori | *
|
234 | 15d35bc5 | aliguori | * The parameter write must be 1 if the offset will be used for a write
|
235 | 15d35bc5 | aliguori | * operation (the block bitmaps is updated then), 0 otherwise.
|
236 | b71d1c2e | aliguori | */
|
237 | 15d35bc5 | aliguori | static inline int64_t get_sector_offset(BlockDriverState *bs, |
238 | 15d35bc5 | aliguori | int64_t sector_num, int write)
|
239 | 6a0f9e82 | bellard | { |
240 | 6a0f9e82 | bellard | BDRVVPCState *s = bs->opaque; |
241 | 6a0f9e82 | bellard | uint64_t offset = sector_num * 512;
|
242 | 6a0f9e82 | bellard | uint64_t bitmap_offset, block_offset; |
243 | 6a0f9e82 | bellard | uint32_t pagetable_index, pageentry_index; |
244 | 6a0f9e82 | bellard | |
245 | 2cfacb62 | aliguori | pagetable_index = offset / s->block_size; |
246 | 2cfacb62 | aliguori | pageentry_index = (offset % s->block_size) / 512;
|
247 | 3b46e624 | ths | |
248 | 15d35bc5 | aliguori | if (pagetable_index >= s->max_table_entries || s->pagetable[pagetable_index] == 0xffffffff) |
249 | 15d35bc5 | aliguori | return -1; // not allocated |
250 | 6a0f9e82 | bellard | |
251 | 378e2aea | aliguori | bitmap_offset = 512 * (uint64_t) s->pagetable[pagetable_index];
|
252 | 15d35bc5 | aliguori | block_offset = bitmap_offset + s->bitmap_size + (512 * pageentry_index);
|
253 | 15d35bc5 | aliguori | |
254 | 15d35bc5 | aliguori | // We must ensure that we don't write to any sectors which are marked as
|
255 | 15d35bc5 | aliguori | // unused in the bitmap. We get away with setting all bits in the block
|
256 | 15d35bc5 | aliguori | // bitmap each time we write to a new block. This might cause Virtual PC to
|
257 | 15d35bc5 | aliguori | // miss sparse read optimization, but it's not a problem in terms of
|
258 | 15d35bc5 | aliguori | // correctness.
|
259 | 15d35bc5 | aliguori | if (write && (s->last_bitmap_offset != bitmap_offset)) {
|
260 | 15d35bc5 | aliguori | uint8_t bitmap[s->bitmap_size]; |
261 | 15d35bc5 | aliguori | |
262 | 15d35bc5 | aliguori | s->last_bitmap_offset = bitmap_offset; |
263 | 15d35bc5 | aliguori | memset(bitmap, 0xff, s->bitmap_size);
|
264 | 66f82cee | Kevin Wolf | bdrv_pwrite(bs->file, bitmap_offset, bitmap, s->bitmap_size); |
265 | 15d35bc5 | aliguori | } |
266 | 3b46e624 | ths | |
267 | 26a76461 | bellard | // printf("sector: %" PRIx64 ", index: %x, offset: %x, bioff: %" PRIx64 ", bloff: %" PRIx64 "\n",
|
268 | 6a0f9e82 | bellard | // sector_num, pagetable_index, pageentry_index,
|
269 | 6a0f9e82 | bellard | // bitmap_offset, block_offset);
|
270 | 6a0f9e82 | bellard | |
271 | 6a0f9e82 | bellard | // disabled by reason
|
272 | 6a0f9e82 | bellard | #if 0
|
273 | 6a0f9e82 | bellard | #ifdef CACHE
|
274 | 6a0f9e82 | bellard | if (bitmap_offset != s->last_bitmap)
|
275 | 6a0f9e82 | bellard | {
|
276 | 6a0f9e82 | bellard | lseek(s->fd, bitmap_offset, SEEK_SET);
|
277 | 6a0f9e82 | bellard | |
278 | 6a0f9e82 | bellard | s->last_bitmap = bitmap_offset;
|
279 | 5fafdf24 | ths | |
280 | 6a0f9e82 | bellard | // Scary! Bitmap is stored as big endian 32bit entries,
|
281 | 6a0f9e82 | bellard | // while we used to look it up byte by byte
|
282 | 6a0f9e82 | bellard | read(s->fd, s->pageentry_u8, 512);
|
283 | 6a0f9e82 | bellard | for (i = 0; i < 128; i++)
|
284 | 6a0f9e82 | bellard | be32_to_cpus(&s->pageentry_u32[i]);
|
285 | 6a0f9e82 | bellard | }
|
286 | 6a0f9e82 | bellard | |
287 | 6a0f9e82 | bellard | if ((s->pageentry_u8[pageentry_index / 8] >> (pageentry_index % 8)) & 1)
|
288 | 6a0f9e82 | bellard | return -1;
|
289 | 6a0f9e82 | bellard | #else
|
290 | 6a0f9e82 | bellard | lseek(s->fd, bitmap_offset + (pageentry_index / 8), SEEK_SET);
|
291 | 5fafdf24 | ths | |
292 | 6a0f9e82 | bellard | read(s->fd, &bitmap_entry, 1);
|
293 | 6a0f9e82 | bellard | |
294 | 6a0f9e82 | bellard | if ((bitmap_entry >> (pageentry_index % 8)) & 1) |
295 | 6a0f9e82 | bellard | return -1; // not allocated |
296 | 6a0f9e82 | bellard | #endif
|
297 | 6a0f9e82 | bellard | #endif
|
298 | 6a0f9e82 | bellard | |
299 | b71d1c2e | aliguori | return block_offset;
|
300 | 6a0f9e82 | bellard | } |
301 | 6a0f9e82 | bellard | |
302 | 15d35bc5 | aliguori | /*
|
303 | 15d35bc5 | aliguori | * Writes the footer to the end of the image file. This is needed when the
|
304 | 15d35bc5 | aliguori | * file grows as it overwrites the old footer
|
305 | 15d35bc5 | aliguori | *
|
306 | 15d35bc5 | aliguori | * Returns 0 on success and < 0 on error
|
307 | 15d35bc5 | aliguori | */
|
308 | 15d35bc5 | aliguori | static int rewrite_footer(BlockDriverState* bs) |
309 | 15d35bc5 | aliguori | { |
310 | 15d35bc5 | aliguori | int ret;
|
311 | 15d35bc5 | aliguori | BDRVVPCState *s = bs->opaque; |
312 | 15d35bc5 | aliguori | int64_t offset = s->free_data_block_offset; |
313 | 15d35bc5 | aliguori | |
314 | 66f82cee | Kevin Wolf | ret = bdrv_pwrite(bs->file, offset, s->footer_buf, HEADER_SIZE); |
315 | 15d35bc5 | aliguori | if (ret < 0) |
316 | 15d35bc5 | aliguori | return ret;
|
317 | 15d35bc5 | aliguori | |
318 | 15d35bc5 | aliguori | return 0; |
319 | 15d35bc5 | aliguori | } |
320 | 15d35bc5 | aliguori | |
321 | 15d35bc5 | aliguori | /*
|
322 | 15d35bc5 | aliguori | * Allocates a new block. This involves writing a new footer and updating
|
323 | 15d35bc5 | aliguori | * the Block Allocation Table to use the space at the old end of the image
|
324 | 15d35bc5 | aliguori | * file (overwriting the old footer)
|
325 | 15d35bc5 | aliguori | *
|
326 | 15d35bc5 | aliguori | * Returns the sectors' offset in the image file on success and < 0 on error
|
327 | 15d35bc5 | aliguori | */
|
328 | 15d35bc5 | aliguori | static int64_t alloc_block(BlockDriverState* bs, int64_t sector_num)
|
329 | 15d35bc5 | aliguori | { |
330 | 15d35bc5 | aliguori | BDRVVPCState *s = bs->opaque; |
331 | 15d35bc5 | aliguori | int64_t bat_offset; |
332 | 15d35bc5 | aliguori | uint32_t index, bat_value; |
333 | 15d35bc5 | aliguori | int ret;
|
334 | 15d35bc5 | aliguori | uint8_t bitmap[s->bitmap_size]; |
335 | 15d35bc5 | aliguori | |
336 | 15d35bc5 | aliguori | // Check if sector_num is valid
|
337 | 15d35bc5 | aliguori | if ((sector_num < 0) || (sector_num > bs->total_sectors)) |
338 | 15d35bc5 | aliguori | return -1; |
339 | 15d35bc5 | aliguori | |
340 | 15d35bc5 | aliguori | // Write entry into in-memory BAT
|
341 | 15d35bc5 | aliguori | index = (sector_num * 512) / s->block_size;
|
342 | 15d35bc5 | aliguori | if (s->pagetable[index] != 0xFFFFFFFF) |
343 | 15d35bc5 | aliguori | return -1; |
344 | 15d35bc5 | aliguori | |
345 | 15d35bc5 | aliguori | s->pagetable[index] = s->free_data_block_offset / 512;
|
346 | 15d35bc5 | aliguori | |
347 | 15d35bc5 | aliguori | // Initialize the block's bitmap
|
348 | 15d35bc5 | aliguori | memset(bitmap, 0xff, s->bitmap_size);
|
349 | 66f82cee | Kevin Wolf | bdrv_pwrite(bs->file, s->free_data_block_offset, bitmap, s->bitmap_size); |
350 | 15d35bc5 | aliguori | |
351 | 15d35bc5 | aliguori | // Write new footer (the old one will be overwritten)
|
352 | 15d35bc5 | aliguori | s->free_data_block_offset += s->block_size + s->bitmap_size; |
353 | 15d35bc5 | aliguori | ret = rewrite_footer(bs); |
354 | 15d35bc5 | aliguori | if (ret < 0) |
355 | 15d35bc5 | aliguori | goto fail;
|
356 | 15d35bc5 | aliguori | |
357 | 15d35bc5 | aliguori | // Write BAT entry to disk
|
358 | 15d35bc5 | aliguori | bat_offset = s->bat_offset + (4 * index);
|
359 | 15d35bc5 | aliguori | bat_value = be32_to_cpu(s->pagetable[index]); |
360 | 66f82cee | Kevin Wolf | ret = bdrv_pwrite(bs->file, bat_offset, &bat_value, 4);
|
361 | 15d35bc5 | aliguori | if (ret < 0) |
362 | 15d35bc5 | aliguori | goto fail;
|
363 | 15d35bc5 | aliguori | |
364 | 15d35bc5 | aliguori | return get_sector_offset(bs, sector_num, 0); |
365 | 15d35bc5 | aliguori | |
366 | 15d35bc5 | aliguori | fail:
|
367 | 15d35bc5 | aliguori | s->free_data_block_offset -= (s->block_size + s->bitmap_size); |
368 | 15d35bc5 | aliguori | return -1; |
369 | 15d35bc5 | aliguori | } |
370 | 15d35bc5 | aliguori | |
371 | 5fafdf24 | ths | static int vpc_read(BlockDriverState *bs, int64_t sector_num, |
372 | 6a0f9e82 | bellard | uint8_t *buf, int nb_sectors)
|
373 | 6a0f9e82 | bellard | { |
374 | 6c6ea921 | Kevin Wolf | BDRVVPCState *s = bs->opaque; |
375 | 6a0f9e82 | bellard | int ret;
|
376 | b71d1c2e | aliguori | int64_t offset; |
377 | 6c6ea921 | Kevin Wolf | int64_t sectors, sectors_per_block; |
378 | 6a0f9e82 | bellard | |
379 | 6a0f9e82 | bellard | while (nb_sectors > 0) { |
380 | 15d35bc5 | aliguori | offset = get_sector_offset(bs, sector_num, 0);
|
381 | b71d1c2e | aliguori | |
382 | 6c6ea921 | Kevin Wolf | sectors_per_block = s->block_size >> BDRV_SECTOR_BITS; |
383 | 6c6ea921 | Kevin Wolf | sectors = sectors_per_block - (sector_num % sectors_per_block); |
384 | 6c6ea921 | Kevin Wolf | if (sectors > nb_sectors) {
|
385 | 6c6ea921 | Kevin Wolf | sectors = nb_sectors; |
386 | 6c6ea921 | Kevin Wolf | } |
387 | 6c6ea921 | Kevin Wolf | |
388 | b71d1c2e | aliguori | if (offset == -1) { |
389 | 6c6ea921 | Kevin Wolf | memset(buf, 0, sectors * BDRV_SECTOR_SIZE);
|
390 | b71d1c2e | aliguori | } else {
|
391 | 6c6ea921 | Kevin Wolf | ret = bdrv_pread(bs->file, offset, buf, |
392 | 6c6ea921 | Kevin Wolf | sectors * BDRV_SECTOR_SIZE); |
393 | 6c6ea921 | Kevin Wolf | if (ret != sectors * BDRV_SECTOR_SIZE) {
|
394 | b71d1c2e | aliguori | return -1; |
395 | 6c6ea921 | Kevin Wolf | } |
396 | b71d1c2e | aliguori | } |
397 | b71d1c2e | aliguori | |
398 | 6c6ea921 | Kevin Wolf | nb_sectors -= sectors; |
399 | 6c6ea921 | Kevin Wolf | sector_num += sectors; |
400 | 6c6ea921 | Kevin Wolf | buf += sectors * BDRV_SECTOR_SIZE; |
401 | 6a0f9e82 | bellard | } |
402 | 6a0f9e82 | bellard | return 0; |
403 | 6a0f9e82 | bellard | } |
404 | 6a0f9e82 | bellard | |
405 | 15d35bc5 | aliguori | static int vpc_write(BlockDriverState *bs, int64_t sector_num, |
406 | 15d35bc5 | aliguori | const uint8_t *buf, int nb_sectors) |
407 | 15d35bc5 | aliguori | { |
408 | 6c6ea921 | Kevin Wolf | BDRVVPCState *s = bs->opaque; |
409 | 15d35bc5 | aliguori | int64_t offset; |
410 | 6c6ea921 | Kevin Wolf | int64_t sectors, sectors_per_block; |
411 | 15d35bc5 | aliguori | int ret;
|
412 | 15d35bc5 | aliguori | |
413 | 15d35bc5 | aliguori | while (nb_sectors > 0) { |
414 | 15d35bc5 | aliguori | offset = get_sector_offset(bs, sector_num, 1);
|
415 | 15d35bc5 | aliguori | |
416 | 6c6ea921 | Kevin Wolf | sectors_per_block = s->block_size >> BDRV_SECTOR_BITS; |
417 | 6c6ea921 | Kevin Wolf | sectors = sectors_per_block - (sector_num % sectors_per_block); |
418 | 6c6ea921 | Kevin Wolf | if (sectors > nb_sectors) {
|
419 | 6c6ea921 | Kevin Wolf | sectors = nb_sectors; |
420 | 6c6ea921 | Kevin Wolf | } |
421 | 6c6ea921 | Kevin Wolf | |
422 | 15d35bc5 | aliguori | if (offset == -1) { |
423 | 15d35bc5 | aliguori | offset = alloc_block(bs, sector_num); |
424 | 15d35bc5 | aliguori | if (offset < 0) |
425 | 15d35bc5 | aliguori | return -1; |
426 | 15d35bc5 | aliguori | } |
427 | 15d35bc5 | aliguori | |
428 | 6c6ea921 | Kevin Wolf | ret = bdrv_pwrite(bs->file, offset, buf, sectors * BDRV_SECTOR_SIZE); |
429 | 6c6ea921 | Kevin Wolf | if (ret != sectors * BDRV_SECTOR_SIZE) {
|
430 | 15d35bc5 | aliguori | return -1; |
431 | 6c6ea921 | Kevin Wolf | } |
432 | 15d35bc5 | aliguori | |
433 | 6c6ea921 | Kevin Wolf | nb_sectors -= sectors; |
434 | 6c6ea921 | Kevin Wolf | sector_num += sectors; |
435 | 6c6ea921 | Kevin Wolf | buf += sectors * BDRV_SECTOR_SIZE; |
436 | 15d35bc5 | aliguori | } |
437 | 15d35bc5 | aliguori | |
438 | 15d35bc5 | aliguori | return 0; |
439 | 15d35bc5 | aliguori | } |
440 | 15d35bc5 | aliguori | |
441 | 57c7d9e5 | aliguori | |
442 | 57c7d9e5 | aliguori | /*
|
443 | 57c7d9e5 | aliguori | * Calculates the number of cylinders, heads and sectors per cylinder
|
444 | 57c7d9e5 | aliguori | * based on a given number of sectors. This is the algorithm described
|
445 | 57c7d9e5 | aliguori | * in the VHD specification.
|
446 | 57c7d9e5 | aliguori | *
|
447 | 57c7d9e5 | aliguori | * Note that the geometry doesn't always exactly match total_sectors but
|
448 | 57c7d9e5 | aliguori | * may round it down.
|
449 | 6e9ea0c0 | aurel32 | *
|
450 | 6e9ea0c0 | aurel32 | * Returns 0 on success, -EFBIG if the size is larger than 127 GB
|
451 | 57c7d9e5 | aliguori | */
|
452 | 6e9ea0c0 | aurel32 | static int calculate_geometry(int64_t total_sectors, uint16_t* cyls, |
453 | 57c7d9e5 | aliguori | uint8_t* heads, uint8_t* secs_per_cyl) |
454 | 57c7d9e5 | aliguori | { |
455 | 57c7d9e5 | aliguori | uint32_t cyls_times_heads; |
456 | 57c7d9e5 | aliguori | |
457 | 57c7d9e5 | aliguori | if (total_sectors > 65535 * 16 * 255) |
458 | 6e9ea0c0 | aurel32 | return -EFBIG;
|
459 | 57c7d9e5 | aliguori | |
460 | 57c7d9e5 | aliguori | if (total_sectors > 65535 * 16 * 63) { |
461 | 57c7d9e5 | aliguori | *secs_per_cyl = 255;
|
462 | 57c7d9e5 | aliguori | *heads = 16;
|
463 | 57c7d9e5 | aliguori | cyls_times_heads = total_sectors / *secs_per_cyl; |
464 | 57c7d9e5 | aliguori | } else {
|
465 | 57c7d9e5 | aliguori | *secs_per_cyl = 17;
|
466 | 57c7d9e5 | aliguori | cyls_times_heads = total_sectors / *secs_per_cyl; |
467 | 57c7d9e5 | aliguori | *heads = (cyls_times_heads + 1023) / 1024; |
468 | 57c7d9e5 | aliguori | |
469 | 57c7d9e5 | aliguori | if (*heads < 4) |
470 | 57c7d9e5 | aliguori | *heads = 4;
|
471 | 57c7d9e5 | aliguori | |
472 | 57c7d9e5 | aliguori | if (cyls_times_heads >= (*heads * 1024) || *heads > 16) { |
473 | 57c7d9e5 | aliguori | *secs_per_cyl = 31;
|
474 | 57c7d9e5 | aliguori | *heads = 16;
|
475 | 57c7d9e5 | aliguori | cyls_times_heads = total_sectors / *secs_per_cyl; |
476 | 57c7d9e5 | aliguori | } |
477 | 57c7d9e5 | aliguori | |
478 | 57c7d9e5 | aliguori | if (cyls_times_heads >= (*heads * 1024)) { |
479 | 57c7d9e5 | aliguori | *secs_per_cyl = 63;
|
480 | 57c7d9e5 | aliguori | *heads = 16;
|
481 | 57c7d9e5 | aliguori | cyls_times_heads = total_sectors / *secs_per_cyl; |
482 | 57c7d9e5 | aliguori | } |
483 | 57c7d9e5 | aliguori | } |
484 | 57c7d9e5 | aliguori | |
485 | dede4188 | Stefan Weil | *cyls = cyls_times_heads / *heads; |
486 | 6e9ea0c0 | aurel32 | |
487 | 6e9ea0c0 | aurel32 | return 0; |
488 | 57c7d9e5 | aliguori | } |
489 | 57c7d9e5 | aliguori | |
490 | 0e7e1989 | Kevin Wolf | static int vpc_create(const char *filename, QEMUOptionParameter *options) |
491 | 57c7d9e5 | aliguori | { |
492 | 57c7d9e5 | aliguori | uint8_t buf[1024];
|
493 | 57c7d9e5 | aliguori | struct vhd_footer* footer = (struct vhd_footer*) buf; |
494 | 57c7d9e5 | aliguori | struct vhd_dyndisk_header* dyndisk_header =
|
495 | 57c7d9e5 | aliguori | (struct vhd_dyndisk_header*) buf;
|
496 | 57c7d9e5 | aliguori | int fd, i;
|
497 | dede4188 | Stefan Weil | uint16_t cyls = 0;
|
498 | dede4188 | Stefan Weil | uint8_t heads = 0;
|
499 | dede4188 | Stefan Weil | uint8_t secs_per_cyl = 0;
|
500 | 57c7d9e5 | aliguori | size_t block_size, num_bat_entries; |
501 | 0e7e1989 | Kevin Wolf | int64_t total_sectors = 0;
|
502 | 57c7d9e5 | aliguori | |
503 | 0e7e1989 | Kevin Wolf | // Read out options
|
504 | 0e7e1989 | Kevin Wolf | while (options && options->name) {
|
505 | 0e7e1989 | Kevin Wolf | if (!strcmp(options->name, "size")) { |
506 | 0e7e1989 | Kevin Wolf | total_sectors = options->value.n / 512;
|
507 | 0e7e1989 | Kevin Wolf | } |
508 | 0e7e1989 | Kevin Wolf | options++; |
509 | 0e7e1989 | Kevin Wolf | } |
510 | 57c7d9e5 | aliguori | |
511 | 0e7e1989 | Kevin Wolf | // Create the file
|
512 | 57c7d9e5 | aliguori | fd = open(filename, O_WRONLY | O_CREAT | O_TRUNC | O_BINARY, 0644);
|
513 | 57c7d9e5 | aliguori | if (fd < 0) |
514 | 57c7d9e5 | aliguori | return -EIO;
|
515 | 57c7d9e5 | aliguori | |
516 | dede4188 | Stefan Weil | /* Calculate matching total_size and geometry. Increase the number of
|
517 | dede4188 | Stefan Weil | sectors requested until we get enough (or fail). */
|
518 | dede4188 | Stefan Weil | for (i = 0; total_sectors > (int64_t)cyls * heads * secs_per_cyl; i++) { |
519 | dede4188 | Stefan Weil | if (calculate_geometry(total_sectors + i,
|
520 | dede4188 | Stefan Weil | &cyls, &heads, &secs_per_cyl)) { |
521 | dede4188 | Stefan Weil | return -EFBIG;
|
522 | dede4188 | Stefan Weil | } |
523 | dede4188 | Stefan Weil | } |
524 | 57c7d9e5 | aliguori | total_sectors = (int64_t) cyls * heads * secs_per_cyl; |
525 | 57c7d9e5 | aliguori | |
526 | 57c7d9e5 | aliguori | // Prepare the Hard Disk Footer
|
527 | 57c7d9e5 | aliguori | memset(buf, 0, 1024); |
528 | 57c7d9e5 | aliguori | |
529 | 5ec4d682 | Nathan Froyd | memcpy(footer->creator, "conectix", 8); |
530 | 57c7d9e5 | aliguori | // TODO Check if "qemu" creator_app is ok for VPC
|
531 | 5ec4d682 | Nathan Froyd | memcpy(footer->creator_app, "qemu", 4); |
532 | 5ec4d682 | Nathan Froyd | memcpy(footer->creator_os, "Wi2k", 4); |
533 | 57c7d9e5 | aliguori | |
534 | 57c7d9e5 | aliguori | footer->features = be32_to_cpu(0x02);
|
535 | 57c7d9e5 | aliguori | footer->version = be32_to_cpu(0x00010000);
|
536 | 57c7d9e5 | aliguori | footer->data_offset = be64_to_cpu(HEADER_SIZE); |
537 | 57c7d9e5 | aliguori | footer->timestamp = be32_to_cpu(time(NULL) - VHD_TIMESTAMP_BASE);
|
538 | 57c7d9e5 | aliguori | |
539 | 57c7d9e5 | aliguori | // Version of Virtual PC 2007
|
540 | 57c7d9e5 | aliguori | footer->major = be16_to_cpu(0x0005);
|
541 | 57c7d9e5 | aliguori | footer->minor =be16_to_cpu(0x0003);
|
542 | 57c7d9e5 | aliguori | |
543 | 57c7d9e5 | aliguori | footer->orig_size = be64_to_cpu(total_sectors * 512);
|
544 | 57c7d9e5 | aliguori | footer->size = be64_to_cpu(total_sectors * 512);
|
545 | 57c7d9e5 | aliguori | |
546 | 57c7d9e5 | aliguori | footer->cyls = be16_to_cpu(cyls); |
547 | 57c7d9e5 | aliguori | footer->heads = heads; |
548 | 57c7d9e5 | aliguori | footer->secs_per_cyl = secs_per_cyl; |
549 | 57c7d9e5 | aliguori | |
550 | 57c7d9e5 | aliguori | footer->type = be32_to_cpu(VHD_DYNAMIC); |
551 | 57c7d9e5 | aliguori | |
552 | 57c7d9e5 | aliguori | // TODO uuid is missing
|
553 | 57c7d9e5 | aliguori | |
554 | 57c7d9e5 | aliguori | footer->checksum = be32_to_cpu(vpc_checksum(buf, HEADER_SIZE)); |
555 | 57c7d9e5 | aliguori | |
556 | 57c7d9e5 | aliguori | // Write the footer (twice: at the beginning and at the end)
|
557 | 57c7d9e5 | aliguori | block_size = 0x200000;
|
558 | 57c7d9e5 | aliguori | num_bat_entries = (total_sectors + block_size / 512) / (block_size / 512); |
559 | 57c7d9e5 | aliguori | |
560 | 57c7d9e5 | aliguori | if (write(fd, buf, HEADER_SIZE) != HEADER_SIZE)
|
561 | 57c7d9e5 | aliguori | return -EIO;
|
562 | 57c7d9e5 | aliguori | |
563 | 57c7d9e5 | aliguori | if (lseek(fd, 1536 + ((num_bat_entries * 4 + 511) & ~511), SEEK_SET) < 0) |
564 | 57c7d9e5 | aliguori | return -EIO;
|
565 | 57c7d9e5 | aliguori | if (write(fd, buf, HEADER_SIZE) != HEADER_SIZE)
|
566 | 57c7d9e5 | aliguori | return -EIO;
|
567 | 57c7d9e5 | aliguori | |
568 | 57c7d9e5 | aliguori | // Write the initial BAT
|
569 | 57c7d9e5 | aliguori | if (lseek(fd, 3 * 512, SEEK_SET) < 0) |
570 | 57c7d9e5 | aliguori | return -EIO;
|
571 | 57c7d9e5 | aliguori | |
572 | 57c7d9e5 | aliguori | memset(buf, 0xFF, 512); |
573 | 57c7d9e5 | aliguori | for (i = 0; i < (num_bat_entries * 4 + 511) / 512; i++) |
574 | 57c7d9e5 | aliguori | if (write(fd, buf, 512) != 512) |
575 | 57c7d9e5 | aliguori | return -EIO;
|
576 | 57c7d9e5 | aliguori | |
577 | 57c7d9e5 | aliguori | |
578 | 57c7d9e5 | aliguori | // Prepare the Dynamic Disk Header
|
579 | 57c7d9e5 | aliguori | memset(buf, 0, 1024); |
580 | 57c7d9e5 | aliguori | |
581 | 5ec4d682 | Nathan Froyd | memcpy(dyndisk_header->magic, "cxsparse", 8); |
582 | 57c7d9e5 | aliguori | |
583 | 57c7d9e5 | aliguori | dyndisk_header->data_offset = be64_to_cpu(0xFFFFFFFF);
|
584 | 57c7d9e5 | aliguori | dyndisk_header->table_offset = be64_to_cpu(3 * 512); |
585 | 57c7d9e5 | aliguori | dyndisk_header->version = be32_to_cpu(0x00010000);
|
586 | 57c7d9e5 | aliguori | dyndisk_header->block_size = be32_to_cpu(block_size); |
587 | 57c7d9e5 | aliguori | dyndisk_header->max_table_entries = be32_to_cpu(num_bat_entries); |
588 | 57c7d9e5 | aliguori | |
589 | 57c7d9e5 | aliguori | dyndisk_header->checksum = be32_to_cpu(vpc_checksum(buf, 1024));
|
590 | 57c7d9e5 | aliguori | |
591 | 57c7d9e5 | aliguori | // Write the header
|
592 | 57c7d9e5 | aliguori | if (lseek(fd, 512, SEEK_SET) < 0) |
593 | 57c7d9e5 | aliguori | return -EIO;
|
594 | 57c7d9e5 | aliguori | if (write(fd, buf, 1024) != 1024) |
595 | 57c7d9e5 | aliguori | return -EIO;
|
596 | 57c7d9e5 | aliguori | |
597 | 57c7d9e5 | aliguori | close(fd); |
598 | 57c7d9e5 | aliguori | return 0; |
599 | 57c7d9e5 | aliguori | } |
600 | 57c7d9e5 | aliguori | |
601 | 6a0f9e82 | bellard | static void vpc_close(BlockDriverState *bs) |
602 | 6a0f9e82 | bellard | { |
603 | 6a0f9e82 | bellard | BDRVVPCState *s = bs->opaque; |
604 | 6a0f9e82 | bellard | qemu_free(s->pagetable); |
605 | 6a0f9e82 | bellard | #ifdef CACHE
|
606 | 6a0f9e82 | bellard | qemu_free(s->pageentry_u8); |
607 | 6a0f9e82 | bellard | #endif
|
608 | 6a0f9e82 | bellard | } |
609 | 6a0f9e82 | bellard | |
610 | 0e7e1989 | Kevin Wolf | static QEMUOptionParameter vpc_create_options[] = {
|
611 | db08adf5 | Kevin Wolf | { |
612 | db08adf5 | Kevin Wolf | .name = BLOCK_OPT_SIZE, |
613 | db08adf5 | Kevin Wolf | .type = OPT_SIZE, |
614 | db08adf5 | Kevin Wolf | .help = "Virtual disk size"
|
615 | db08adf5 | Kevin Wolf | }, |
616 | 0e7e1989 | Kevin Wolf | { NULL }
|
617 | 0e7e1989 | Kevin Wolf | }; |
618 | 0e7e1989 | Kevin Wolf | |
619 | 5efa9d5a | Anthony Liguori | static BlockDriver bdrv_vpc = {
|
620 | e60f469c | aurel32 | .format_name = "vpc",
|
621 | e60f469c | aurel32 | .instance_size = sizeof(BDRVVPCState),
|
622 | e60f469c | aurel32 | .bdrv_probe = vpc_probe, |
623 | e60f469c | aurel32 | .bdrv_open = vpc_open, |
624 | e60f469c | aurel32 | .bdrv_read = vpc_read, |
625 | e60f469c | aurel32 | .bdrv_write = vpc_write, |
626 | e60f469c | aurel32 | .bdrv_close = vpc_close, |
627 | e60f469c | aurel32 | .bdrv_create = vpc_create, |
628 | 0e7e1989 | Kevin Wolf | |
629 | 0e7e1989 | Kevin Wolf | .create_options = vpc_create_options, |
630 | 6a0f9e82 | bellard | }; |
631 | 5efa9d5a | Anthony Liguori | |
632 | 5efa9d5a | Anthony Liguori | static void bdrv_vpc_init(void) |
633 | 5efa9d5a | Anthony Liguori | { |
634 | 5efa9d5a | Anthony Liguori | bdrv_register(&bdrv_vpc); |
635 | 5efa9d5a | Anthony Liguori | } |
636 | 5efa9d5a | Anthony Liguori | |
637 | 5efa9d5a | Anthony Liguori | block_init(bdrv_vpc_init); |