]>
Commit | Line | Data |
---|---|---|
acbe4801 KW |
1 | /* |
2 | * IDE test cases | |
3 | * | |
4 | * Copyright (c) 2013 Kevin Wolf <[email protected]> | |
5 | * | |
6 | * Permission is hereby granted, free of charge, to any person obtaining a copy | |
7 | * of this software and associated documentation files (the "Software"), to deal | |
8 | * in the Software without restriction, including without limitation the rights | |
9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |
10 | * copies of the Software, and to permit persons to whom the Software is | |
11 | * furnished to do so, subject to the following conditions: | |
12 | * | |
13 | * The above copyright notice and this permission notice shall be included in | |
14 | * all copies or substantial portions of the Software. | |
15 | * | |
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |
22 | * THE SOFTWARE. | |
23 | */ | |
24 | ||
53239262 | 25 | #include "qemu/osdep.h" |
acbe4801 | 26 | |
acbe4801 KW |
27 | |
28 | #include "libqtest.h" | |
72c85e94 | 29 | #include "libqos/libqos.h" |
b95739dc KW |
30 | #include "libqos/pci-pc.h" |
31 | #include "libqos/malloc-pc.h" | |
acbe4801 KW |
32 | |
33 | #include "qemu-common.h" | |
58369e22 | 34 | #include "qemu/bswap.h" |
b95739dc KW |
35 | #include "hw/pci/pci_ids.h" |
36 | #include "hw/pci/pci_regs.h" | |
acbe4801 KW |
37 | |
38 | #define TEST_IMAGE_SIZE 64 * 1024 * 1024 | |
39 | ||
40 | #define IDE_PCI_DEV 1 | |
41 | #define IDE_PCI_FUNC 1 | |
42 | ||
43 | #define IDE_BASE 0x1f0 | |
44 | #define IDE_PRIMARY_IRQ 14 | |
45 | ||
f7ba8d7f JS |
46 | #define ATAPI_BLOCK_SIZE 2048 |
47 | ||
48 | /* How many bytes to receive via ATAPI PIO at one time. | |
49 | * Must be less than 0xFFFF. */ | |
50 | #define BYTE_COUNT_LIMIT 5120 | |
51 | ||
acbe4801 KW |
52 | enum { |
53 | reg_data = 0x0, | |
00ea63fd | 54 | reg_feature = 0x1, |
acbe4801 KW |
55 | reg_nsectors = 0x2, |
56 | reg_lba_low = 0x3, | |
57 | reg_lba_middle = 0x4, | |
58 | reg_lba_high = 0x5, | |
59 | reg_device = 0x6, | |
60 | reg_status = 0x7, | |
61 | reg_command = 0x7, | |
62 | }; | |
63 | ||
64 | enum { | |
65 | BSY = 0x80, | |
66 | DRDY = 0x40, | |
67 | DF = 0x20, | |
68 | DRQ = 0x08, | |
69 | ERR = 0x01, | |
70 | }; | |
71 | ||
72 | enum { | |
c27d5656 | 73 | DEV = 0x10, |
b95739dc KW |
74 | LBA = 0x40, |
75 | }; | |
76 | ||
77 | enum { | |
78 | bmreg_cmd = 0x0, | |
79 | bmreg_status = 0x2, | |
80 | bmreg_prdt = 0x4, | |
81 | }; | |
82 | ||
83 | enum { | |
84 | CMD_READ_DMA = 0xc8, | |
85 | CMD_WRITE_DMA = 0xca, | |
bd07684a | 86 | CMD_FLUSH_CACHE = 0xe7, |
acbe4801 | 87 | CMD_IDENTIFY = 0xec, |
f7ba8d7f | 88 | CMD_PACKET = 0xa0, |
948eaed1 KW |
89 | |
90 | CMDF_ABORT = 0x100, | |
d7b7e580 | 91 | CMDF_NO_BM = 0x200, |
acbe4801 KW |
92 | }; |
93 | ||
b95739dc KW |
94 | enum { |
95 | BM_CMD_START = 0x1, | |
96 | BM_CMD_WRITE = 0x8, /* write = from device to memory */ | |
97 | }; | |
98 | ||
99 | enum { | |
100 | BM_STS_ACTIVE = 0x1, | |
101 | BM_STS_ERROR = 0x2, | |
102 | BM_STS_INTR = 0x4, | |
103 | }; | |
104 | ||
105 | enum { | |
106 | PRDT_EOT = 0x80000000, | |
107 | }; | |
108 | ||
acbe4801 KW |
109 | #define assert_bit_set(data, mask) g_assert_cmphex((data) & (mask), ==, (mask)) |
110 | #define assert_bit_clear(data, mask) g_assert_cmphex((data) & (mask), ==, 0) | |
111 | ||
b95739dc KW |
112 | static QPCIBus *pcibus = NULL; |
113 | static QGuestAllocator *guest_malloc; | |
114 | ||
acbe4801 | 115 | static char tmp_path[] = "/tmp/qtest.XXXXXX"; |
14a92e5f | 116 | static char debug_path[] = "/tmp/qtest-blkdebug.XXXXXX"; |
acbe4801 KW |
117 | |
118 | static void ide_test_start(const char *cmdline_fmt, ...) | |
119 | { | |
120 | va_list ap; | |
121 | char *cmdline; | |
122 | ||
123 | va_start(ap, cmdline_fmt); | |
124 | cmdline = g_strdup_vprintf(cmdline_fmt, ap); | |
125 | va_end(ap); | |
126 | ||
127 | qtest_start(cmdline); | |
b95739dc | 128 | guest_malloc = pc_alloc_init(); |
e42de189 JS |
129 | |
130 | g_free(cmdline); | |
acbe4801 KW |
131 | } |
132 | ||
133 | static void ide_test_quit(void) | |
134 | { | |
0142f88b JS |
135 | pc_alloc_uninit(guest_malloc); |
136 | guest_malloc = NULL; | |
1d9358e6 | 137 | qtest_end(); |
acbe4801 KW |
138 | } |
139 | ||
b95739dc KW |
140 | static QPCIDevice *get_pci_device(uint16_t *bmdma_base) |
141 | { | |
142 | QPCIDevice *dev; | |
143 | uint16_t vendor_id, device_id; | |
144 | ||
145 | if (!pcibus) { | |
2ecd7e2f | 146 | pcibus = qpci_init_pc(NULL); |
b95739dc KW |
147 | } |
148 | ||
149 | /* Find PCI device and verify it's the right one */ | |
150 | dev = qpci_device_find(pcibus, QPCI_DEVFN(IDE_PCI_DEV, IDE_PCI_FUNC)); | |
151 | g_assert(dev != NULL); | |
152 | ||
153 | vendor_id = qpci_config_readw(dev, PCI_VENDOR_ID); | |
154 | device_id = qpci_config_readw(dev, PCI_DEVICE_ID); | |
155 | g_assert(vendor_id == PCI_VENDOR_ID_INTEL); | |
156 | g_assert(device_id == PCI_DEVICE_ID_INTEL_82371SB_1); | |
157 | ||
158 | /* Map bmdma BAR */ | |
6ce7100e | 159 | *bmdma_base = (uint16_t)(uintptr_t) qpci_iomap(dev, 4, NULL); |
b95739dc KW |
160 | |
161 | qpci_device_enable(dev); | |
162 | ||
163 | return dev; | |
164 | } | |
165 | ||
166 | static void free_pci_device(QPCIDevice *dev) | |
167 | { | |
168 | /* libqos doesn't have a function for this, so free it manually */ | |
169 | g_free(dev); | |
170 | } | |
171 | ||
172 | typedef struct PrdtEntry { | |
173 | uint32_t addr; | |
174 | uint32_t size; | |
175 | } QEMU_PACKED PrdtEntry; | |
176 | ||
177 | #define assert_bit_set(data, mask) g_assert_cmphex((data) & (mask), ==, (mask)) | |
178 | #define assert_bit_clear(data, mask) g_assert_cmphex((data) & (mask), ==, 0) | |
179 | ||
180 | static int send_dma_request(int cmd, uint64_t sector, int nb_sectors, | |
00ea63fd JS |
181 | PrdtEntry *prdt, int prdt_entries, |
182 | void(*post_exec)(uint64_t sector, int nb_sectors)) | |
b95739dc KW |
183 | { |
184 | QPCIDevice *dev; | |
185 | uint16_t bmdma_base; | |
186 | uintptr_t guest_prdt; | |
187 | size_t len; | |
188 | bool from_dev; | |
189 | uint8_t status; | |
948eaed1 | 190 | int flags; |
b95739dc KW |
191 | |
192 | dev = get_pci_device(&bmdma_base); | |
193 | ||
948eaed1 KW |
194 | flags = cmd & ~0xff; |
195 | cmd &= 0xff; | |
196 | ||
b95739dc KW |
197 | switch (cmd) { |
198 | case CMD_READ_DMA: | |
00ea63fd JS |
199 | case CMD_PACKET: |
200 | /* Assuming we only test data reads w/ ATAPI, otherwise we need to know | |
201 | * the SCSI command being sent in the packet, too. */ | |
b95739dc KW |
202 | from_dev = true; |
203 | break; | |
204 | case CMD_WRITE_DMA: | |
205 | from_dev = false; | |
206 | break; | |
207 | default: | |
208 | g_assert_not_reached(); | |
209 | } | |
210 | ||
d7b7e580 KW |
211 | if (flags & CMDF_NO_BM) { |
212 | qpci_config_writew(dev, PCI_COMMAND, | |
213 | PCI_COMMAND_IO | PCI_COMMAND_MEMORY); | |
214 | } | |
215 | ||
b95739dc KW |
216 | /* Select device 0 */ |
217 | outb(IDE_BASE + reg_device, 0 | LBA); | |
218 | ||
219 | /* Stop any running transfer, clear any pending interrupt */ | |
220 | outb(bmdma_base + bmreg_cmd, 0); | |
221 | outb(bmdma_base + bmreg_status, BM_STS_INTR); | |
222 | ||
223 | /* Setup PRDT */ | |
224 | len = sizeof(*prdt) * prdt_entries; | |
225 | guest_prdt = guest_alloc(guest_malloc, len); | |
226 | memwrite(guest_prdt, prdt, len); | |
227 | outl(bmdma_base + bmreg_prdt, guest_prdt); | |
228 | ||
229 | /* ATA DMA command */ | |
00ea63fd JS |
230 | if (cmd == CMD_PACKET) { |
231 | /* Enables ATAPI DMA; otherwise PIO is attempted */ | |
232 | outb(IDE_BASE + reg_feature, 0x01); | |
233 | } else { | |
234 | outb(IDE_BASE + reg_nsectors, nb_sectors); | |
235 | outb(IDE_BASE + reg_lba_low, sector & 0xff); | |
236 | outb(IDE_BASE + reg_lba_middle, (sector >> 8) & 0xff); | |
237 | outb(IDE_BASE + reg_lba_high, (sector >> 16) & 0xff); | |
238 | } | |
b95739dc KW |
239 | |
240 | outb(IDE_BASE + reg_command, cmd); | |
241 | ||
00ea63fd JS |
242 | if (post_exec) { |
243 | post_exec(sector, nb_sectors); | |
244 | } | |
245 | ||
b95739dc KW |
246 | /* Start DMA transfer */ |
247 | outb(bmdma_base + bmreg_cmd, BM_CMD_START | (from_dev ? BM_CMD_WRITE : 0)); | |
248 | ||
948eaed1 KW |
249 | if (flags & CMDF_ABORT) { |
250 | outb(bmdma_base + bmreg_cmd, 0); | |
251 | } | |
252 | ||
b95739dc KW |
253 | /* Wait for the DMA transfer to complete */ |
254 | do { | |
255 | status = inb(bmdma_base + bmreg_status); | |
256 | } while ((status & (BM_STS_ACTIVE | BM_STS_INTR)) == BM_STS_ACTIVE); | |
257 | ||
258 | g_assert_cmpint(get_irq(IDE_PRIMARY_IRQ), ==, !!(status & BM_STS_INTR)); | |
259 | ||
260 | /* Check IDE status code */ | |
261 | assert_bit_set(inb(IDE_BASE + reg_status), DRDY); | |
262 | assert_bit_clear(inb(IDE_BASE + reg_status), BSY | DRQ); | |
263 | ||
264 | /* Reading the status register clears the IRQ */ | |
265 | g_assert(!get_irq(IDE_PRIMARY_IRQ)); | |
266 | ||
267 | /* Stop DMA transfer if still active */ | |
268 | if (status & BM_STS_ACTIVE) { | |
269 | outb(bmdma_base + bmreg_cmd, 0); | |
270 | } | |
271 | ||
272 | free_pci_device(dev); | |
273 | ||
274 | return status; | |
275 | } | |
276 | ||
277 | static void test_bmdma_simple_rw(void) | |
278 | { | |
279 | uint8_t status; | |
280 | uint8_t *buf; | |
281 | uint8_t *cmpbuf; | |
282 | size_t len = 512; | |
283 | uintptr_t guest_buf = guest_alloc(guest_malloc, len); | |
284 | ||
285 | PrdtEntry prdt[] = { | |
262f27b9 KW |
286 | { |
287 | .addr = cpu_to_le32(guest_buf), | |
288 | .size = cpu_to_le32(len | PRDT_EOT), | |
289 | }, | |
b95739dc KW |
290 | }; |
291 | ||
292 | buf = g_malloc(len); | |
293 | cmpbuf = g_malloc(len); | |
294 | ||
295 | /* Write 0x55 pattern to sector 0 */ | |
296 | memset(buf, 0x55, len); | |
297 | memwrite(guest_buf, buf, len); | |
298 | ||
00ea63fd JS |
299 | status = send_dma_request(CMD_WRITE_DMA, 0, 1, prdt, |
300 | ARRAY_SIZE(prdt), NULL); | |
b95739dc KW |
301 | g_assert_cmphex(status, ==, BM_STS_INTR); |
302 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
303 | ||
304 | /* Write 0xaa pattern to sector 1 */ | |
305 | memset(buf, 0xaa, len); | |
306 | memwrite(guest_buf, buf, len); | |
307 | ||
00ea63fd JS |
308 | status = send_dma_request(CMD_WRITE_DMA, 1, 1, prdt, |
309 | ARRAY_SIZE(prdt), NULL); | |
b95739dc KW |
310 | g_assert_cmphex(status, ==, BM_STS_INTR); |
311 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
312 | ||
313 | /* Read and verify 0x55 pattern in sector 0 */ | |
314 | memset(cmpbuf, 0x55, len); | |
315 | ||
00ea63fd | 316 | status = send_dma_request(CMD_READ_DMA, 0, 1, prdt, ARRAY_SIZE(prdt), NULL); |
b95739dc KW |
317 | g_assert_cmphex(status, ==, BM_STS_INTR); |
318 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
319 | ||
320 | memread(guest_buf, buf, len); | |
321 | g_assert(memcmp(buf, cmpbuf, len) == 0); | |
322 | ||
323 | /* Read and verify 0xaa pattern in sector 1 */ | |
324 | memset(cmpbuf, 0xaa, len); | |
325 | ||
00ea63fd | 326 | status = send_dma_request(CMD_READ_DMA, 1, 1, prdt, ARRAY_SIZE(prdt), NULL); |
b95739dc KW |
327 | g_assert_cmphex(status, ==, BM_STS_INTR); |
328 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
329 | ||
330 | memread(guest_buf, buf, len); | |
331 | g_assert(memcmp(buf, cmpbuf, len) == 0); | |
332 | ||
333 | ||
334 | g_free(buf); | |
335 | g_free(cmpbuf); | |
336 | } | |
337 | ||
948eaed1 KW |
338 | static void test_bmdma_short_prdt(void) |
339 | { | |
340 | uint8_t status; | |
341 | ||
342 | PrdtEntry prdt[] = { | |
262f27b9 KW |
343 | { |
344 | .addr = 0, | |
345 | .size = cpu_to_le32(0x10 | PRDT_EOT), | |
346 | }, | |
948eaed1 KW |
347 | }; |
348 | ||
349 | /* Normal request */ | |
350 | status = send_dma_request(CMD_READ_DMA, 0, 1, | |
00ea63fd | 351 | prdt, ARRAY_SIZE(prdt), NULL); |
948eaed1 KW |
352 | g_assert_cmphex(status, ==, 0); |
353 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
354 | ||
355 | /* Abort the request before it completes */ | |
356 | status = send_dma_request(CMD_READ_DMA | CMDF_ABORT, 0, 1, | |
00ea63fd | 357 | prdt, ARRAY_SIZE(prdt), NULL); |
948eaed1 KW |
358 | g_assert_cmphex(status, ==, 0); |
359 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
360 | } | |
361 | ||
58732810 SH |
362 | static void test_bmdma_one_sector_short_prdt(void) |
363 | { | |
364 | uint8_t status; | |
365 | ||
366 | /* Read 2 sectors but only give 1 sector in PRDT */ | |
367 | PrdtEntry prdt[] = { | |
368 | { | |
369 | .addr = 0, | |
370 | .size = cpu_to_le32(0x200 | PRDT_EOT), | |
371 | }, | |
372 | }; | |
373 | ||
374 | /* Normal request */ | |
375 | status = send_dma_request(CMD_READ_DMA, 0, 2, | |
00ea63fd | 376 | prdt, ARRAY_SIZE(prdt), NULL); |
58732810 SH |
377 | g_assert_cmphex(status, ==, 0); |
378 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
379 | ||
380 | /* Abort the request before it completes */ | |
381 | status = send_dma_request(CMD_READ_DMA | CMDF_ABORT, 0, 2, | |
00ea63fd | 382 | prdt, ARRAY_SIZE(prdt), NULL); |
58732810 SH |
383 | g_assert_cmphex(status, ==, 0); |
384 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
385 | } | |
386 | ||
948eaed1 KW |
387 | static void test_bmdma_long_prdt(void) |
388 | { | |
389 | uint8_t status; | |
390 | ||
391 | PrdtEntry prdt[] = { | |
262f27b9 KW |
392 | { |
393 | .addr = 0, | |
394 | .size = cpu_to_le32(0x1000 | PRDT_EOT), | |
395 | }, | |
948eaed1 KW |
396 | }; |
397 | ||
398 | /* Normal request */ | |
399 | status = send_dma_request(CMD_READ_DMA, 0, 1, | |
00ea63fd | 400 | prdt, ARRAY_SIZE(prdt), NULL); |
948eaed1 KW |
401 | g_assert_cmphex(status, ==, BM_STS_ACTIVE | BM_STS_INTR); |
402 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
403 | ||
404 | /* Abort the request before it completes */ | |
405 | status = send_dma_request(CMD_READ_DMA | CMDF_ABORT, 0, 1, | |
00ea63fd | 406 | prdt, ARRAY_SIZE(prdt), NULL); |
948eaed1 KW |
407 | g_assert_cmphex(status, ==, BM_STS_INTR); |
408 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
409 | } | |
410 | ||
d7b7e580 KW |
411 | static void test_bmdma_no_busmaster(void) |
412 | { | |
413 | uint8_t status; | |
414 | ||
415 | /* No PRDT_EOT, each entry addr 0/size 64k, and in theory qemu shouldn't be | |
416 | * able to access it anyway because the Bus Master bit in the PCI command | |
417 | * register isn't set. This is complete nonsense, but it used to be pretty | |
418 | * good at confusing and occasionally crashing qemu. */ | |
419 | PrdtEntry prdt[4096] = { }; | |
420 | ||
421 | status = send_dma_request(CMD_READ_DMA | CMDF_NO_BM, 0, 512, | |
00ea63fd | 422 | prdt, ARRAY_SIZE(prdt), NULL); |
d7b7e580 KW |
423 | |
424 | /* Not entirely clear what the expected result is, but this is what we get | |
425 | * in practice. At least we want to be aware of any changes. */ | |
426 | g_assert_cmphex(status, ==, BM_STS_ACTIVE | BM_STS_INTR); | |
427 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
428 | } | |
429 | ||
b95739dc KW |
430 | static void test_bmdma_setup(void) |
431 | { | |
432 | ide_test_start( | |
b8e665e4 | 433 | "-drive file=%s,if=ide,serial=%s,cache=writeback,format=raw " |
b95739dc KW |
434 | "-global ide-hd.ver=%s", |
435 | tmp_path, "testdisk", "version"); | |
baca2b9e | 436 | qtest_irq_intercept_in(global_qtest, "ioapic"); |
b95739dc KW |
437 | } |
438 | ||
439 | static void test_bmdma_teardown(void) | |
440 | { | |
441 | ide_test_quit(); | |
442 | } | |
443 | ||
262f27b9 KW |
444 | static void string_cpu_to_be16(uint16_t *s, size_t bytes) |
445 | { | |
446 | g_assert((bytes & 1) == 0); | |
447 | bytes /= 2; | |
448 | ||
449 | while (bytes--) { | |
450 | *s = cpu_to_be16(*s); | |
451 | s++; | |
452 | } | |
453 | } | |
454 | ||
acbe4801 KW |
455 | static void test_identify(void) |
456 | { | |
457 | uint8_t data; | |
458 | uint16_t buf[256]; | |
459 | int i; | |
460 | int ret; | |
461 | ||
462 | ide_test_start( | |
b8e665e4 | 463 | "-drive file=%s,if=ide,serial=%s,cache=writeback,format=raw " |
acbe4801 KW |
464 | "-global ide-hd.ver=%s", |
465 | tmp_path, "testdisk", "version"); | |
466 | ||
467 | /* IDENTIFY command on device 0*/ | |
468 | outb(IDE_BASE + reg_device, 0); | |
469 | outb(IDE_BASE + reg_command, CMD_IDENTIFY); | |
470 | ||
471 | /* Read in the IDENTIFY buffer and check registers */ | |
472 | data = inb(IDE_BASE + reg_device); | |
c27d5656 | 473 | g_assert_cmpint(data & DEV, ==, 0); |
acbe4801 KW |
474 | |
475 | for (i = 0; i < 256; i++) { | |
476 | data = inb(IDE_BASE + reg_status); | |
477 | assert_bit_set(data, DRDY | DRQ); | |
478 | assert_bit_clear(data, BSY | DF | ERR); | |
479 | ||
480 | ((uint16_t*) buf)[i] = inw(IDE_BASE + reg_data); | |
481 | } | |
482 | ||
483 | data = inb(IDE_BASE + reg_status); | |
484 | assert_bit_set(data, DRDY); | |
485 | assert_bit_clear(data, BSY | DF | ERR | DRQ); | |
486 | ||
487 | /* Check serial number/version in the buffer */ | |
262f27b9 KW |
488 | string_cpu_to_be16(&buf[10], 20); |
489 | ret = memcmp(&buf[10], "testdisk ", 20); | |
acbe4801 KW |
490 | g_assert(ret == 0); |
491 | ||
262f27b9 KW |
492 | string_cpu_to_be16(&buf[23], 8); |
493 | ret = memcmp(&buf[23], "version ", 8); | |
acbe4801 KW |
494 | g_assert(ret == 0); |
495 | ||
496 | /* Write cache enabled bit */ | |
497 | assert_bit_set(buf[85], 0x20); | |
498 | ||
499 | ide_test_quit(); | |
500 | } | |
501 | ||
2dd7e10d EY |
502 | /* |
503 | * Write sector 1 with random data to make IDE storage dirty | |
504 | * Needed for flush tests so that flushes actually go though the block layer | |
505 | */ | |
506 | static void make_dirty(uint8_t device) | |
507 | { | |
508 | uint8_t status; | |
509 | size_t len = 512; | |
510 | uintptr_t guest_buf; | |
511 | void* buf; | |
512 | ||
513 | guest_buf = guest_alloc(guest_malloc, len); | |
514 | buf = g_malloc(len); | |
515 | g_assert(guest_buf); | |
516 | g_assert(buf); | |
517 | ||
518 | memwrite(guest_buf, buf, len); | |
519 | ||
520 | PrdtEntry prdt[] = { | |
521 | { | |
522 | .addr = cpu_to_le32(guest_buf), | |
523 | .size = cpu_to_le32(len | PRDT_EOT), | |
524 | }, | |
525 | }; | |
526 | ||
527 | status = send_dma_request(CMD_WRITE_DMA, 1, 1, prdt, | |
528 | ARRAY_SIZE(prdt), NULL); | |
529 | g_assert_cmphex(status, ==, BM_STS_INTR); | |
530 | assert_bit_clear(inb(IDE_BASE + reg_status), DF | ERR); | |
531 | ||
532 | g_free(buf); | |
533 | } | |
534 | ||
bd07684a KW |
535 | static void test_flush(void) |
536 | { | |
537 | uint8_t data; | |
538 | ||
539 | ide_test_start( | |
b8e665e4 | 540 | "-drive file=blkdebug::%s,if=ide,cache=writeback,format=raw", |
bd07684a KW |
541 | tmp_path); |
542 | ||
2dd7e10d EY |
543 | qtest_irq_intercept_in(global_qtest, "ioapic"); |
544 | ||
545 | /* Dirty media so that CMD_FLUSH_CACHE will actually go to disk */ | |
546 | make_dirty(0); | |
547 | ||
bd07684a | 548 | /* Delay the completion of the flush request until we explicitly do it */ |
5fb48d96 | 549 | g_free(hmp("qemu-io ide0-hd0 \"break flush_to_os A\"")); |
bd07684a KW |
550 | |
551 | /* FLUSH CACHE command on device 0*/ | |
552 | outb(IDE_BASE + reg_device, 0); | |
553 | outb(IDE_BASE + reg_command, CMD_FLUSH_CACHE); | |
554 | ||
555 | /* Check status while request is in flight*/ | |
556 | data = inb(IDE_BASE + reg_status); | |
557 | assert_bit_set(data, BSY | DRDY); | |
558 | assert_bit_clear(data, DF | ERR | DRQ); | |
559 | ||
560 | /* Complete the command */ | |
5fb48d96 | 561 | g_free(hmp("qemu-io ide0-hd0 \"resume A\"")); |
bd07684a KW |
562 | |
563 | /* Check registers */ | |
564 | data = inb(IDE_BASE + reg_device); | |
565 | g_assert_cmpint(data & DEV, ==, 0); | |
566 | ||
22bfa16e MR |
567 | do { |
568 | data = inb(IDE_BASE + reg_status); | |
569 | } while (data & BSY); | |
570 | ||
bd07684a KW |
571 | assert_bit_set(data, DRDY); |
572 | assert_bit_clear(data, BSY | DF | ERR | DRQ); | |
573 | ||
574 | ide_test_quit(); | |
575 | } | |
576 | ||
baca2b9e | 577 | static void test_retry_flush(const char *machine) |
14a92e5f PB |
578 | { |
579 | uint8_t data; | |
580 | const char *s; | |
14a92e5f PB |
581 | |
582 | prepare_blkdebug_script(debug_path, "flush_to_disk"); | |
583 | ||
584 | ide_test_start( | |
585 | "-vnc none " | |
b8e665e4 KW |
586 | "-drive file=blkdebug:%s:%s,if=ide,cache=writeback,format=raw," |
587 | "rerror=stop,werror=stop", | |
14a92e5f PB |
588 | debug_path, tmp_path); |
589 | ||
2dd7e10d EY |
590 | qtest_irq_intercept_in(global_qtest, "ioapic"); |
591 | ||
592 | /* Dirty media so that CMD_FLUSH_CACHE will actually go to disk */ | |
593 | make_dirty(0); | |
594 | ||
14a92e5f PB |
595 | /* FLUSH CACHE command on device 0*/ |
596 | outb(IDE_BASE + reg_device, 0); | |
597 | outb(IDE_BASE + reg_command, CMD_FLUSH_CACHE); | |
598 | ||
599 | /* Check status while request is in flight*/ | |
600 | data = inb(IDE_BASE + reg_status); | |
601 | assert_bit_set(data, BSY | DRDY); | |
602 | assert_bit_clear(data, DF | ERR | DRQ); | |
603 | ||
8fe941f7 | 604 | qmp_eventwait("STOP"); |
14a92e5f PB |
605 | |
606 | /* Complete the command */ | |
607 | s = "{'execute':'cont' }"; | |
608 | qmp_discard_response(s); | |
609 | ||
610 | /* Check registers */ | |
611 | data = inb(IDE_BASE + reg_device); | |
612 | g_assert_cmpint(data & DEV, ==, 0); | |
613 | ||
614 | do { | |
615 | data = inb(IDE_BASE + reg_status); | |
616 | } while (data & BSY); | |
617 | ||
618 | assert_bit_set(data, DRDY); | |
619 | assert_bit_clear(data, BSY | DF | ERR | DRQ); | |
620 | ||
621 | ide_test_quit(); | |
622 | } | |
623 | ||
f7f3ff1d KW |
624 | static void test_flush_nodev(void) |
625 | { | |
626 | ide_test_start(""); | |
627 | ||
628 | /* FLUSH CACHE command on device 0*/ | |
629 | outb(IDE_BASE + reg_device, 0); | |
630 | outb(IDE_BASE + reg_command, CMD_FLUSH_CACHE); | |
631 | ||
632 | /* Just testing that qemu doesn't crash... */ | |
633 | ||
634 | ide_test_quit(); | |
635 | } | |
636 | ||
041088c7 | 637 | static void test_pci_retry_flush(void) |
baca2b9e JS |
638 | { |
639 | test_retry_flush("pc"); | |
640 | } | |
641 | ||
041088c7 | 642 | static void test_isa_retry_flush(void) |
baca2b9e JS |
643 | { |
644 | test_retry_flush("isapc"); | |
645 | } | |
646 | ||
f7ba8d7f JS |
647 | typedef struct Read10CDB { |
648 | uint8_t opcode; | |
649 | uint8_t flags; | |
650 | uint32_t lba; | |
651 | uint8_t reserved; | |
652 | uint16_t nblocks; | |
653 | uint8_t control; | |
654 | uint16_t padding; | |
655 | } __attribute__((__packed__)) Read10CDB; | |
656 | ||
00ea63fd | 657 | static void send_scsi_cdb_read10(uint64_t lba, int nblocks) |
f7ba8d7f JS |
658 | { |
659 | Read10CDB pkt = { .padding = 0 }; | |
660 | int i; | |
661 | ||
00ea63fd JS |
662 | g_assert_cmpint(lba, <=, UINT32_MAX); |
663 | g_assert_cmpint(nblocks, <=, UINT16_MAX); | |
664 | g_assert_cmpint(nblocks, >=, 0); | |
665 | ||
f7ba8d7f JS |
666 | /* Construct SCSI CDB packet */ |
667 | pkt.opcode = 0x28; | |
668 | pkt.lba = cpu_to_be32(lba); | |
669 | pkt.nblocks = cpu_to_be16(nblocks); | |
670 | ||
671 | /* Send Packet */ | |
672 | for (i = 0; i < sizeof(Read10CDB)/2; i++) { | |
ec6b69ca | 673 | outw(IDE_BASE + reg_data, cpu_to_le16(((uint16_t *)&pkt)[i])); |
f7ba8d7f JS |
674 | } |
675 | } | |
676 | ||
677 | static void nsleep(int64_t nsecs) | |
678 | { | |
679 | const struct timespec val = { .tv_nsec = nsecs }; | |
680 | nanosleep(&val, NULL); | |
681 | clock_set(nsecs); | |
682 | } | |
683 | ||
684 | static uint8_t ide_wait_clear(uint8_t flag) | |
685 | { | |
f7ba8d7f | 686 | uint8_t data; |
9c73517c | 687 | time_t st; |
f7ba8d7f JS |
688 | |
689 | /* Wait with a 5 second timeout */ | |
9c73517c JS |
690 | time(&st); |
691 | while (true) { | |
f7ba8d7f JS |
692 | data = inb(IDE_BASE + reg_status); |
693 | if (!(data & flag)) { | |
694 | return data; | |
695 | } | |
9c73517c JS |
696 | if (difftime(time(NULL), st) > 5.0) { |
697 | break; | |
698 | } | |
f7ba8d7f JS |
699 | nsleep(400); |
700 | } | |
701 | g_assert_not_reached(); | |
702 | } | |
703 | ||
704 | static void ide_wait_intr(int irq) | |
705 | { | |
9c73517c | 706 | time_t st; |
f7ba8d7f JS |
707 | bool intr; |
708 | ||
9c73517c JS |
709 | time(&st); |
710 | while (true) { | |
f7ba8d7f JS |
711 | intr = get_irq(irq); |
712 | if (intr) { | |
713 | return; | |
714 | } | |
9c73517c JS |
715 | if (difftime(time(NULL), st) > 5.0) { |
716 | break; | |
717 | } | |
f7ba8d7f JS |
718 | nsleep(400); |
719 | } | |
720 | ||
721 | g_assert_not_reached(); | |
722 | } | |
723 | ||
724 | static void cdrom_pio_impl(int nblocks) | |
725 | { | |
726 | FILE *fh; | |
727 | int patt_blocks = MAX(16, nblocks); | |
728 | size_t patt_len = ATAPI_BLOCK_SIZE * patt_blocks; | |
729 | char *pattern = g_malloc(patt_len); | |
730 | size_t rxsize = ATAPI_BLOCK_SIZE * nblocks; | |
731 | uint16_t *rx = g_malloc0(rxsize); | |
732 | int i, j; | |
733 | uint8_t data; | |
734 | uint16_t limit; | |
735 | ||
736 | /* Prepopulate the CDROM with an interesting pattern */ | |
737 | generate_pattern(pattern, patt_len, ATAPI_BLOCK_SIZE); | |
738 | fh = fopen(tmp_path, "w+"); | |
739 | fwrite(pattern, ATAPI_BLOCK_SIZE, patt_blocks, fh); | |
740 | fclose(fh); | |
741 | ||
742 | ide_test_start("-drive if=none,file=%s,media=cdrom,format=raw,id=sr0,index=0 " | |
743 | "-device ide-cd,drive=sr0,bus=ide.0", tmp_path); | |
744 | qtest_irq_intercept_in(global_qtest, "ioapic"); | |
745 | ||
746 | /* PACKET command on device 0 */ | |
747 | outb(IDE_BASE + reg_device, 0); | |
748 | outb(IDE_BASE + reg_lba_middle, BYTE_COUNT_LIMIT & 0xFF); | |
749 | outb(IDE_BASE + reg_lba_high, (BYTE_COUNT_LIMIT >> 8 & 0xFF)); | |
750 | outb(IDE_BASE + reg_command, CMD_PACKET); | |
f348daf3 | 751 | /* HP0: Check_Status_A State */ |
f7ba8d7f JS |
752 | nsleep(400); |
753 | data = ide_wait_clear(BSY); | |
f348daf3 | 754 | /* HP1: Send_Packet State */ |
f7ba8d7f JS |
755 | assert_bit_set(data, DRQ | DRDY); |
756 | assert_bit_clear(data, ERR | DF | BSY); | |
757 | ||
758 | /* SCSI CDB (READ10) -- read n*2048 bytes from block 0 */ | |
759 | send_scsi_cdb_read10(0, nblocks); | |
760 | ||
f7ba8d7f JS |
761 | /* Read data back: occurs in bursts of 'BYTE_COUNT_LIMIT' bytes. |
762 | * If BYTE_COUNT_LIMIT is odd, we transfer BYTE_COUNT_LIMIT - 1 bytes. | |
763 | * We allow an odd limit only when the remaining transfer size is | |
764 | * less than BYTE_COUNT_LIMIT. However, SCSI's read10 command can only | |
765 | * request n blocks, so our request size is always even. | |
766 | * For this reason, we assume there is never a hanging byte to fetch. */ | |
767 | g_assert(!(rxsize & 1)); | |
768 | limit = BYTE_COUNT_LIMIT & ~1; | |
769 | for (i = 0; i < DIV_ROUND_UP(rxsize, limit); i++) { | |
770 | size_t offset = i * (limit / 2); | |
771 | size_t rem = (rxsize / 2) - offset; | |
a421f3c3 JS |
772 | |
773 | /* HP3: INTRQ_Wait */ | |
774 | ide_wait_intr(IDE_PRIMARY_IRQ); | |
775 | ||
776 | /* HP2: Check_Status_B (and clear IRQ) */ | |
f348daf3 PL |
777 | data = ide_wait_clear(BSY); |
778 | assert_bit_set(data, DRQ | DRDY); | |
779 | assert_bit_clear(data, ERR | DF | BSY); | |
a421f3c3 | 780 | |
f348daf3 | 781 | /* HP4: Transfer_Data */ |
f7ba8d7f | 782 | for (j = 0; j < MIN((limit / 2), rem); j++) { |
ec6b69ca | 783 | rx[offset + j] = le16_to_cpu(inw(IDE_BASE + reg_data)); |
f7ba8d7f | 784 | } |
f7ba8d7f | 785 | } |
a421f3c3 JS |
786 | |
787 | /* Check for final completion IRQ */ | |
788 | ide_wait_intr(IDE_PRIMARY_IRQ); | |
789 | ||
790 | /* Sanity check final state */ | |
f7ba8d7f JS |
791 | data = ide_wait_clear(DRQ); |
792 | assert_bit_set(data, DRDY); | |
793 | assert_bit_clear(data, DRQ | ERR | DF | BSY); | |
794 | ||
795 | g_assert_cmpint(memcmp(pattern, rx, rxsize), ==, 0); | |
796 | g_free(pattern); | |
797 | g_free(rx); | |
798 | test_bmdma_teardown(); | |
799 | } | |
800 | ||
801 | static void test_cdrom_pio(void) | |
802 | { | |
803 | cdrom_pio_impl(1); | |
804 | } | |
805 | ||
806 | static void test_cdrom_pio_large(void) | |
807 | { | |
808 | /* Test a few loops of the PIO DRQ mechanism. */ | |
809 | cdrom_pio_impl(BYTE_COUNT_LIMIT * 4 / ATAPI_BLOCK_SIZE); | |
810 | } | |
811 | ||
00ea63fd JS |
812 | |
813 | static void test_cdrom_dma(void) | |
814 | { | |
815 | static const size_t len = ATAPI_BLOCK_SIZE; | |
816 | char *pattern = g_malloc(ATAPI_BLOCK_SIZE * 16); | |
817 | char *rx = g_malloc0(len); | |
818 | uintptr_t guest_buf; | |
819 | PrdtEntry prdt[1]; | |
820 | FILE *fh; | |
821 | ||
822 | ide_test_start("-drive if=none,file=%s,media=cdrom,format=raw,id=sr0,index=0 " | |
823 | "-device ide-cd,drive=sr0,bus=ide.0", tmp_path); | |
824 | qtest_irq_intercept_in(global_qtest, "ioapic"); | |
825 | ||
826 | guest_buf = guest_alloc(guest_malloc, len); | |
827 | prdt[0].addr = cpu_to_le32(guest_buf); | |
828 | prdt[0].size = cpu_to_le32(len | PRDT_EOT); | |
829 | ||
830 | generate_pattern(pattern, ATAPI_BLOCK_SIZE * 16, ATAPI_BLOCK_SIZE); | |
831 | fh = fopen(tmp_path, "w+"); | |
832 | fwrite(pattern, ATAPI_BLOCK_SIZE, 16, fh); | |
833 | fclose(fh); | |
834 | ||
835 | send_dma_request(CMD_PACKET, 0, 1, prdt, 1, send_scsi_cdb_read10); | |
836 | ||
837 | /* Read back data from guest memory into local qtest memory */ | |
838 | memread(guest_buf, rx, len); | |
839 | g_assert_cmpint(memcmp(pattern, rx, len), ==, 0); | |
840 | ||
841 | g_free(pattern); | |
842 | g_free(rx); | |
843 | test_bmdma_teardown(); | |
844 | } | |
845 | ||
acbe4801 KW |
846 | int main(int argc, char **argv) |
847 | { | |
848 | const char *arch = qtest_get_arch(); | |
849 | int fd; | |
850 | int ret; | |
851 | ||
852 | /* Check architecture */ | |
853 | if (strcmp(arch, "i386") && strcmp(arch, "x86_64")) { | |
854 | g_test_message("Skipping test for non-x86\n"); | |
855 | return 0; | |
856 | } | |
857 | ||
14a92e5f PB |
858 | /* Create temporary blkdebug instructions */ |
859 | fd = mkstemp(debug_path); | |
860 | g_assert(fd >= 0); | |
861 | close(fd); | |
862 | ||
acbe4801 KW |
863 | /* Create a temporary raw image */ |
864 | fd = mkstemp(tmp_path); | |
865 | g_assert(fd >= 0); | |
866 | ret = ftruncate(fd, TEST_IMAGE_SIZE); | |
867 | g_assert(ret == 0); | |
868 | close(fd); | |
869 | ||
870 | /* Run the tests */ | |
871 | g_test_init(&argc, &argv, NULL); | |
872 | ||
873 | qtest_add_func("/ide/identify", test_identify); | |
874 | ||
b95739dc KW |
875 | qtest_add_func("/ide/bmdma/setup", test_bmdma_setup); |
876 | qtest_add_func("/ide/bmdma/simple_rw", test_bmdma_simple_rw); | |
948eaed1 | 877 | qtest_add_func("/ide/bmdma/short_prdt", test_bmdma_short_prdt); |
58732810 SH |
878 | qtest_add_func("/ide/bmdma/one_sector_short_prdt", |
879 | test_bmdma_one_sector_short_prdt); | |
948eaed1 | 880 | qtest_add_func("/ide/bmdma/long_prdt", test_bmdma_long_prdt); |
d7b7e580 | 881 | qtest_add_func("/ide/bmdma/no_busmaster", test_bmdma_no_busmaster); |
b95739dc KW |
882 | qtest_add_func("/ide/bmdma/teardown", test_bmdma_teardown); |
883 | ||
bd07684a | 884 | qtest_add_func("/ide/flush", test_flush); |
baca2b9e JS |
885 | qtest_add_func("/ide/flush/nodev", test_flush_nodev); |
886 | qtest_add_func("/ide/flush/retry_pci", test_pci_retry_flush); | |
887 | qtest_add_func("/ide/flush/retry_isa", test_isa_retry_flush); | |
14a92e5f | 888 | |
f7ba8d7f JS |
889 | qtest_add_func("/ide/cdrom/pio", test_cdrom_pio); |
890 | qtest_add_func("/ide/cdrom/pio_large", test_cdrom_pio_large); | |
00ea63fd | 891 | qtest_add_func("/ide/cdrom/dma", test_cdrom_dma); |
f7ba8d7f | 892 | |
acbe4801 KW |
893 | ret = g_test_run(); |
894 | ||
895 | /* Cleanup */ | |
896 | unlink(tmp_path); | |
14a92e5f | 897 | unlink(debug_path); |
acbe4801 KW |
898 | |
899 | return ret; | |
900 | } |