]>
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 KW |
26 | |
27 | #include <glib.h> | |
28 | ||
29 | #include "libqtest.h" | |
72c85e94 | 30 | #include "libqos/libqos.h" |
b95739dc KW |
31 | #include "libqos/pci-pc.h" |
32 | #include "libqos/malloc-pc.h" | |
acbe4801 KW |
33 | |
34 | #include "qemu-common.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) { | |
146 | pcibus = qpci_init_pc(); | |
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 | ||
bd07684a KW |
502 | static void test_flush(void) |
503 | { | |
504 | uint8_t data; | |
505 | ||
506 | ide_test_start( | |
b8e665e4 | 507 | "-drive file=blkdebug::%s,if=ide,cache=writeback,format=raw", |
bd07684a KW |
508 | tmp_path); |
509 | ||
510 | /* Delay the completion of the flush request until we explicitly do it */ | |
5fb48d96 | 511 | g_free(hmp("qemu-io ide0-hd0 \"break flush_to_os A\"")); |
bd07684a KW |
512 | |
513 | /* FLUSH CACHE command on device 0*/ | |
514 | outb(IDE_BASE + reg_device, 0); | |
515 | outb(IDE_BASE + reg_command, CMD_FLUSH_CACHE); | |
516 | ||
517 | /* Check status while request is in flight*/ | |
518 | data = inb(IDE_BASE + reg_status); | |
519 | assert_bit_set(data, BSY | DRDY); | |
520 | assert_bit_clear(data, DF | ERR | DRQ); | |
521 | ||
522 | /* Complete the command */ | |
5fb48d96 | 523 | g_free(hmp("qemu-io ide0-hd0 \"resume A\"")); |
bd07684a KW |
524 | |
525 | /* Check registers */ | |
526 | data = inb(IDE_BASE + reg_device); | |
527 | g_assert_cmpint(data & DEV, ==, 0); | |
528 | ||
22bfa16e MR |
529 | do { |
530 | data = inb(IDE_BASE + reg_status); | |
531 | } while (data & BSY); | |
532 | ||
bd07684a KW |
533 | assert_bit_set(data, DRDY); |
534 | assert_bit_clear(data, BSY | DF | ERR | DRQ); | |
535 | ||
536 | ide_test_quit(); | |
537 | } | |
538 | ||
baca2b9e | 539 | static void test_retry_flush(const char *machine) |
14a92e5f PB |
540 | { |
541 | uint8_t data; | |
542 | const char *s; | |
14a92e5f PB |
543 | |
544 | prepare_blkdebug_script(debug_path, "flush_to_disk"); | |
545 | ||
546 | ide_test_start( | |
547 | "-vnc none " | |
b8e665e4 KW |
548 | "-drive file=blkdebug:%s:%s,if=ide,cache=writeback,format=raw," |
549 | "rerror=stop,werror=stop", | |
14a92e5f PB |
550 | debug_path, tmp_path); |
551 | ||
552 | /* FLUSH CACHE command on device 0*/ | |
553 | outb(IDE_BASE + reg_device, 0); | |
554 | outb(IDE_BASE + reg_command, CMD_FLUSH_CACHE); | |
555 | ||
556 | /* Check status while request is in flight*/ | |
557 | data = inb(IDE_BASE + reg_status); | |
558 | assert_bit_set(data, BSY | DRDY); | |
559 | assert_bit_clear(data, DF | ERR | DRQ); | |
560 | ||
8fe941f7 | 561 | qmp_eventwait("STOP"); |
14a92e5f PB |
562 | |
563 | /* Complete the command */ | |
564 | s = "{'execute':'cont' }"; | |
565 | qmp_discard_response(s); | |
566 | ||
567 | /* Check registers */ | |
568 | data = inb(IDE_BASE + reg_device); | |
569 | g_assert_cmpint(data & DEV, ==, 0); | |
570 | ||
571 | do { | |
572 | data = inb(IDE_BASE + reg_status); | |
573 | } while (data & BSY); | |
574 | ||
575 | assert_bit_set(data, DRDY); | |
576 | assert_bit_clear(data, BSY | DF | ERR | DRQ); | |
577 | ||
578 | ide_test_quit(); | |
579 | } | |
580 | ||
f7f3ff1d KW |
581 | static void test_flush_nodev(void) |
582 | { | |
583 | ide_test_start(""); | |
584 | ||
585 | /* FLUSH CACHE command on device 0*/ | |
586 | outb(IDE_BASE + reg_device, 0); | |
587 | outb(IDE_BASE + reg_command, CMD_FLUSH_CACHE); | |
588 | ||
589 | /* Just testing that qemu doesn't crash... */ | |
590 | ||
591 | ide_test_quit(); | |
592 | } | |
593 | ||
041088c7 | 594 | static void test_pci_retry_flush(void) |
baca2b9e JS |
595 | { |
596 | test_retry_flush("pc"); | |
597 | } | |
598 | ||
041088c7 | 599 | static void test_isa_retry_flush(void) |
baca2b9e JS |
600 | { |
601 | test_retry_flush("isapc"); | |
602 | } | |
603 | ||
f7ba8d7f JS |
604 | typedef struct Read10CDB { |
605 | uint8_t opcode; | |
606 | uint8_t flags; | |
607 | uint32_t lba; | |
608 | uint8_t reserved; | |
609 | uint16_t nblocks; | |
610 | uint8_t control; | |
611 | uint16_t padding; | |
612 | } __attribute__((__packed__)) Read10CDB; | |
613 | ||
00ea63fd | 614 | static void send_scsi_cdb_read10(uint64_t lba, int nblocks) |
f7ba8d7f JS |
615 | { |
616 | Read10CDB pkt = { .padding = 0 }; | |
617 | int i; | |
618 | ||
00ea63fd JS |
619 | g_assert_cmpint(lba, <=, UINT32_MAX); |
620 | g_assert_cmpint(nblocks, <=, UINT16_MAX); | |
621 | g_assert_cmpint(nblocks, >=, 0); | |
622 | ||
f7ba8d7f JS |
623 | /* Construct SCSI CDB packet */ |
624 | pkt.opcode = 0x28; | |
625 | pkt.lba = cpu_to_be32(lba); | |
626 | pkt.nblocks = cpu_to_be16(nblocks); | |
627 | ||
628 | /* Send Packet */ | |
629 | for (i = 0; i < sizeof(Read10CDB)/2; i++) { | |
ec6b69ca | 630 | outw(IDE_BASE + reg_data, cpu_to_le16(((uint16_t *)&pkt)[i])); |
f7ba8d7f JS |
631 | } |
632 | } | |
633 | ||
634 | static void nsleep(int64_t nsecs) | |
635 | { | |
636 | const struct timespec val = { .tv_nsec = nsecs }; | |
637 | nanosleep(&val, NULL); | |
638 | clock_set(nsecs); | |
639 | } | |
640 | ||
641 | static uint8_t ide_wait_clear(uint8_t flag) | |
642 | { | |
f7ba8d7f | 643 | uint8_t data; |
9c73517c | 644 | time_t st; |
f7ba8d7f JS |
645 | |
646 | /* Wait with a 5 second timeout */ | |
9c73517c JS |
647 | time(&st); |
648 | while (true) { | |
f7ba8d7f JS |
649 | data = inb(IDE_BASE + reg_status); |
650 | if (!(data & flag)) { | |
651 | return data; | |
652 | } | |
9c73517c JS |
653 | if (difftime(time(NULL), st) > 5.0) { |
654 | break; | |
655 | } | |
f7ba8d7f JS |
656 | nsleep(400); |
657 | } | |
658 | g_assert_not_reached(); | |
659 | } | |
660 | ||
661 | static void ide_wait_intr(int irq) | |
662 | { | |
9c73517c | 663 | time_t st; |
f7ba8d7f JS |
664 | bool intr; |
665 | ||
9c73517c JS |
666 | time(&st); |
667 | while (true) { | |
f7ba8d7f JS |
668 | intr = get_irq(irq); |
669 | if (intr) { | |
670 | return; | |
671 | } | |
9c73517c JS |
672 | if (difftime(time(NULL), st) > 5.0) { |
673 | break; | |
674 | } | |
f7ba8d7f JS |
675 | nsleep(400); |
676 | } | |
677 | ||
678 | g_assert_not_reached(); | |
679 | } | |
680 | ||
681 | static void cdrom_pio_impl(int nblocks) | |
682 | { | |
683 | FILE *fh; | |
684 | int patt_blocks = MAX(16, nblocks); | |
685 | size_t patt_len = ATAPI_BLOCK_SIZE * patt_blocks; | |
686 | char *pattern = g_malloc(patt_len); | |
687 | size_t rxsize = ATAPI_BLOCK_SIZE * nblocks; | |
688 | uint16_t *rx = g_malloc0(rxsize); | |
689 | int i, j; | |
690 | uint8_t data; | |
691 | uint16_t limit; | |
692 | ||
693 | /* Prepopulate the CDROM with an interesting pattern */ | |
694 | generate_pattern(pattern, patt_len, ATAPI_BLOCK_SIZE); | |
695 | fh = fopen(tmp_path, "w+"); | |
696 | fwrite(pattern, ATAPI_BLOCK_SIZE, patt_blocks, fh); | |
697 | fclose(fh); | |
698 | ||
699 | ide_test_start("-drive if=none,file=%s,media=cdrom,format=raw,id=sr0,index=0 " | |
700 | "-device ide-cd,drive=sr0,bus=ide.0", tmp_path); | |
701 | qtest_irq_intercept_in(global_qtest, "ioapic"); | |
702 | ||
703 | /* PACKET command on device 0 */ | |
704 | outb(IDE_BASE + reg_device, 0); | |
705 | outb(IDE_BASE + reg_lba_middle, BYTE_COUNT_LIMIT & 0xFF); | |
706 | outb(IDE_BASE + reg_lba_high, (BYTE_COUNT_LIMIT >> 8 & 0xFF)); | |
707 | outb(IDE_BASE + reg_command, CMD_PACKET); | |
f348daf3 | 708 | /* HP0: Check_Status_A State */ |
f7ba8d7f JS |
709 | nsleep(400); |
710 | data = ide_wait_clear(BSY); | |
f348daf3 | 711 | /* HP1: Send_Packet State */ |
f7ba8d7f JS |
712 | assert_bit_set(data, DRQ | DRDY); |
713 | assert_bit_clear(data, ERR | DF | BSY); | |
714 | ||
715 | /* SCSI CDB (READ10) -- read n*2048 bytes from block 0 */ | |
716 | send_scsi_cdb_read10(0, nblocks); | |
717 | ||
f7ba8d7f JS |
718 | /* Read data back: occurs in bursts of 'BYTE_COUNT_LIMIT' bytes. |
719 | * If BYTE_COUNT_LIMIT is odd, we transfer BYTE_COUNT_LIMIT - 1 bytes. | |
720 | * We allow an odd limit only when the remaining transfer size is | |
721 | * less than BYTE_COUNT_LIMIT. However, SCSI's read10 command can only | |
722 | * request n blocks, so our request size is always even. | |
723 | * For this reason, we assume there is never a hanging byte to fetch. */ | |
724 | g_assert(!(rxsize & 1)); | |
725 | limit = BYTE_COUNT_LIMIT & ~1; | |
726 | for (i = 0; i < DIV_ROUND_UP(rxsize, limit); i++) { | |
727 | size_t offset = i * (limit / 2); | |
728 | size_t rem = (rxsize / 2) - offset; | |
a421f3c3 JS |
729 | |
730 | /* HP3: INTRQ_Wait */ | |
731 | ide_wait_intr(IDE_PRIMARY_IRQ); | |
732 | ||
733 | /* HP2: Check_Status_B (and clear IRQ) */ | |
f348daf3 PL |
734 | data = ide_wait_clear(BSY); |
735 | assert_bit_set(data, DRQ | DRDY); | |
736 | assert_bit_clear(data, ERR | DF | BSY); | |
a421f3c3 | 737 | |
f348daf3 | 738 | /* HP4: Transfer_Data */ |
f7ba8d7f | 739 | for (j = 0; j < MIN((limit / 2), rem); j++) { |
ec6b69ca | 740 | rx[offset + j] = le16_to_cpu(inw(IDE_BASE + reg_data)); |
f7ba8d7f | 741 | } |
f7ba8d7f | 742 | } |
a421f3c3 JS |
743 | |
744 | /* Check for final completion IRQ */ | |
745 | ide_wait_intr(IDE_PRIMARY_IRQ); | |
746 | ||
747 | /* Sanity check final state */ | |
f7ba8d7f JS |
748 | data = ide_wait_clear(DRQ); |
749 | assert_bit_set(data, DRDY); | |
750 | assert_bit_clear(data, DRQ | ERR | DF | BSY); | |
751 | ||
752 | g_assert_cmpint(memcmp(pattern, rx, rxsize), ==, 0); | |
753 | g_free(pattern); | |
754 | g_free(rx); | |
755 | test_bmdma_teardown(); | |
756 | } | |
757 | ||
758 | static void test_cdrom_pio(void) | |
759 | { | |
760 | cdrom_pio_impl(1); | |
761 | } | |
762 | ||
763 | static void test_cdrom_pio_large(void) | |
764 | { | |
765 | /* Test a few loops of the PIO DRQ mechanism. */ | |
766 | cdrom_pio_impl(BYTE_COUNT_LIMIT * 4 / ATAPI_BLOCK_SIZE); | |
767 | } | |
768 | ||
00ea63fd JS |
769 | |
770 | static void test_cdrom_dma(void) | |
771 | { | |
772 | static const size_t len = ATAPI_BLOCK_SIZE; | |
773 | char *pattern = g_malloc(ATAPI_BLOCK_SIZE * 16); | |
774 | char *rx = g_malloc0(len); | |
775 | uintptr_t guest_buf; | |
776 | PrdtEntry prdt[1]; | |
777 | FILE *fh; | |
778 | ||
779 | ide_test_start("-drive if=none,file=%s,media=cdrom,format=raw,id=sr0,index=0 " | |
780 | "-device ide-cd,drive=sr0,bus=ide.0", tmp_path); | |
781 | qtest_irq_intercept_in(global_qtest, "ioapic"); | |
782 | ||
783 | guest_buf = guest_alloc(guest_malloc, len); | |
784 | prdt[0].addr = cpu_to_le32(guest_buf); | |
785 | prdt[0].size = cpu_to_le32(len | PRDT_EOT); | |
786 | ||
787 | generate_pattern(pattern, ATAPI_BLOCK_SIZE * 16, ATAPI_BLOCK_SIZE); | |
788 | fh = fopen(tmp_path, "w+"); | |
789 | fwrite(pattern, ATAPI_BLOCK_SIZE, 16, fh); | |
790 | fclose(fh); | |
791 | ||
792 | send_dma_request(CMD_PACKET, 0, 1, prdt, 1, send_scsi_cdb_read10); | |
793 | ||
794 | /* Read back data from guest memory into local qtest memory */ | |
795 | memread(guest_buf, rx, len); | |
796 | g_assert_cmpint(memcmp(pattern, rx, len), ==, 0); | |
797 | ||
798 | g_free(pattern); | |
799 | g_free(rx); | |
800 | test_bmdma_teardown(); | |
801 | } | |
802 | ||
acbe4801 KW |
803 | int main(int argc, char **argv) |
804 | { | |
805 | const char *arch = qtest_get_arch(); | |
806 | int fd; | |
807 | int ret; | |
808 | ||
809 | /* Check architecture */ | |
810 | if (strcmp(arch, "i386") && strcmp(arch, "x86_64")) { | |
811 | g_test_message("Skipping test for non-x86\n"); | |
812 | return 0; | |
813 | } | |
814 | ||
14a92e5f PB |
815 | /* Create temporary blkdebug instructions */ |
816 | fd = mkstemp(debug_path); | |
817 | g_assert(fd >= 0); | |
818 | close(fd); | |
819 | ||
acbe4801 KW |
820 | /* Create a temporary raw image */ |
821 | fd = mkstemp(tmp_path); | |
822 | g_assert(fd >= 0); | |
823 | ret = ftruncate(fd, TEST_IMAGE_SIZE); | |
824 | g_assert(ret == 0); | |
825 | close(fd); | |
826 | ||
827 | /* Run the tests */ | |
828 | g_test_init(&argc, &argv, NULL); | |
829 | ||
830 | qtest_add_func("/ide/identify", test_identify); | |
831 | ||
b95739dc KW |
832 | qtest_add_func("/ide/bmdma/setup", test_bmdma_setup); |
833 | qtest_add_func("/ide/bmdma/simple_rw", test_bmdma_simple_rw); | |
948eaed1 | 834 | qtest_add_func("/ide/bmdma/short_prdt", test_bmdma_short_prdt); |
58732810 SH |
835 | qtest_add_func("/ide/bmdma/one_sector_short_prdt", |
836 | test_bmdma_one_sector_short_prdt); | |
948eaed1 | 837 | qtest_add_func("/ide/bmdma/long_prdt", test_bmdma_long_prdt); |
d7b7e580 | 838 | qtest_add_func("/ide/bmdma/no_busmaster", test_bmdma_no_busmaster); |
b95739dc KW |
839 | qtest_add_func("/ide/bmdma/teardown", test_bmdma_teardown); |
840 | ||
bd07684a | 841 | qtest_add_func("/ide/flush", test_flush); |
baca2b9e JS |
842 | qtest_add_func("/ide/flush/nodev", test_flush_nodev); |
843 | qtest_add_func("/ide/flush/retry_pci", test_pci_retry_flush); | |
844 | qtest_add_func("/ide/flush/retry_isa", test_isa_retry_flush); | |
14a92e5f | 845 | |
f7ba8d7f JS |
846 | qtest_add_func("/ide/cdrom/pio", test_cdrom_pio); |
847 | qtest_add_func("/ide/cdrom/pio_large", test_cdrom_pio_large); | |
00ea63fd | 848 | qtest_add_func("/ide/cdrom/dma", test_cdrom_dma); |
f7ba8d7f | 849 | |
acbe4801 KW |
850 | ret = g_test_run(); |
851 | ||
852 | /* Cleanup */ | |
853 | unlink(tmp_path); | |
14a92e5f | 854 | unlink(debug_path); |
acbe4801 KW |
855 | |
856 | return ret; | |
857 | } |