]>
Commit | Line | Data |
---|---|---|
1cd1031d JS |
1 | /* |
2 | * AHCI test cases | |
3 | * | |
4 | * Copyright (c) 2014 John Snow <jsnow@redhat.com> | |
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" |
8840a843 | 26 | #include <getopt.h> |
1cd1031d JS |
27 | |
28 | #include "libqtest.h" | |
90e5add6 | 29 | #include "libqos/libqos-pc.h" |
90fc5e09 | 30 | #include "libqos/ahci.h" |
1cd1031d | 31 | #include "libqos/pci-pc.h" |
1cd1031d JS |
32 | |
33 | #include "qemu-common.h" | |
452fcdbc | 34 | #include "qapi/qmp/qdict.h" |
1cd1031d JS |
35 | #include "qemu/host-utils.h" |
36 | ||
37 | #include "hw/pci/pci_ids.h" | |
38 | #include "hw/pci/pci_regs.h" | |
39 | ||
917158dc JS |
40 | /* Test images sizes in MB */ |
41 | #define TEST_IMAGE_SIZE_MB_LARGE (200 * 1024) | |
42 | #define TEST_IMAGE_SIZE_MB_SMALL 64 | |
1cd1031d | 43 | |
1cd1031d | 44 | /*** Globals ***/ |
1cd1031d | 45 | static char tmp_path[] = "/tmp/qtest.XXXXXX"; |
cf5aa89e | 46 | static char debug_path[] = "/tmp/qtest-blkdebug.XXXXXX"; |
6d9e7295 | 47 | static char mig_socket[] = "/tmp/qtest-migration.XXXXXX"; |
8840a843 | 48 | static bool ahci_pedantic; |
b236b610 | 49 | static const char *imgfmt; |
917158dc | 50 | static unsigned test_image_size_mb; |
8840a843 | 51 | |
1cd1031d | 52 | /*** Function Declarations ***/ |
8d5eeced | 53 | static void ahci_test_port_spec(AHCIQState *ahci, uint8_t port); |
6100ddb0 JS |
54 | static void ahci_test_pci_spec(AHCIQState *ahci); |
55 | static void ahci_test_pci_caps(AHCIQState *ahci, uint16_t header, | |
8840a843 | 56 | uint8_t offset); |
6100ddb0 JS |
57 | static void ahci_test_satacap(AHCIQState *ahci, uint8_t offset); |
58 | static void ahci_test_msicap(AHCIQState *ahci, uint8_t offset); | |
59 | static void ahci_test_pmcap(AHCIQState *ahci, uint8_t offset); | |
1cd1031d JS |
60 | |
61 | /*** Utilities ***/ | |
62 | ||
917158dc JS |
63 | static uint64_t mb_to_sectors(uint64_t image_size_mb) |
64 | { | |
65 | return (image_size_mb * 1024 * 1024) / AHCI_SECTOR_SIZE; | |
66 | } | |
67 | ||
0fa781e3 JS |
68 | static void string_bswap16(uint16_t *s, size_t bytes) |
69 | { | |
70 | g_assert_cmphex((bytes & 1), ==, 0); | |
71 | bytes /= 2; | |
72 | ||
73 | while (bytes--) { | |
74 | *s = bswap16(*s); | |
75 | s++; | |
76 | } | |
77 | } | |
78 | ||
278128ab JS |
79 | /** |
80 | * Verify that the transfer did not corrupt our state at all. | |
81 | */ | |
e7c8526b | 82 | static void verify_state(AHCIQState *ahci, uint64_t hba_old) |
278128ab JS |
83 | { |
84 | int i, j; | |
85 | uint32_t ahci_fingerprint; | |
86 | uint64_t hba_base; | |
278128ab JS |
87 | AHCICommandHeader cmd; |
88 | ||
89 | ahci_fingerprint = qpci_config_readl(ahci->dev, PCI_VENDOR_ID); | |
90 | g_assert_cmphex(ahci_fingerprint, ==, ahci->fingerprint); | |
91 | ||
92 | /* If we haven't initialized, this is as much as can be validated. */ | |
e7c8526b | 93 | if (!ahci->enabled) { |
278128ab JS |
94 | return; |
95 | } | |
96 | ||
97 | hba_base = (uint64_t)qpci_config_readl(ahci->dev, PCI_BASE_ADDRESS_5); | |
e7c8526b | 98 | g_assert_cmphex(hba_base, ==, hba_old); |
278128ab JS |
99 | |
100 | g_assert_cmphex(ahci_rreg(ahci, AHCI_CAP), ==, ahci->cap); | |
101 | g_assert_cmphex(ahci_rreg(ahci, AHCI_CAP2), ==, ahci->cap2); | |
102 | ||
103 | for (i = 0; i < 32; i++) { | |
104 | g_assert_cmphex(ahci_px_rreg(ahci, i, AHCI_PX_FB), ==, | |
105 | ahci->port[i].fb); | |
106 | g_assert_cmphex(ahci_px_rreg(ahci, i, AHCI_PX_CLB), ==, | |
107 | ahci->port[i].clb); | |
108 | for (j = 0; j < 32; j++) { | |
109 | ahci_get_command_header(ahci, i, j, &cmd); | |
110 | g_assert_cmphex(cmd.prdtl, ==, ahci->port[i].prdtl[j]); | |
111 | g_assert_cmphex(cmd.ctba, ==, ahci->port[i].ctba[j]); | |
112 | } | |
113 | } | |
114 | } | |
115 | ||
116 | static void ahci_migrate(AHCIQState *from, AHCIQState *to, const char *uri) | |
117 | { | |
118 | QOSState *tmp = to->parent; | |
119 | QPCIDevice *dev = to->dev; | |
6d9e7295 | 120 | char *uri_local = NULL; |
e7c8526b | 121 | uint64_t hba_old; |
6d9e7295 | 122 | |
278128ab | 123 | if (uri == NULL) { |
6d9e7295 JS |
124 | uri_local = g_strdup_printf("%s%s", "unix:", mig_socket); |
125 | uri = uri_local; | |
278128ab JS |
126 | } |
127 | ||
e7c8526b DG |
128 | hba_old = (uint64_t)qpci_config_readl(from->dev, PCI_BASE_ADDRESS_5); |
129 | ||
278128ab JS |
130 | /* context will be 'to' after completion. */ |
131 | migrate(from->parent, to->parent, uri); | |
132 | ||
133 | /* We'd like for the AHCIState objects to still point | |
134 | * to information specific to its specific parent | |
135 | * instance, but otherwise just inherit the new data. */ | |
136 | memcpy(to, from, sizeof(AHCIQState)); | |
137 | to->parent = tmp; | |
138 | to->dev = dev; | |
139 | ||
140 | tmp = from->parent; | |
141 | dev = from->dev; | |
142 | memset(from, 0x00, sizeof(AHCIQState)); | |
143 | from->parent = tmp; | |
144 | from->dev = dev; | |
145 | ||
e7c8526b | 146 | verify_state(to, hba_old); |
6d9e7295 | 147 | g_free(uri_local); |
278128ab JS |
148 | } |
149 | ||
1cd1031d JS |
150 | /*** Test Setup & Teardown ***/ |
151 | ||
152 | /** | |
dd0029c0 | 153 | * Start a Q35 machine and bookmark a handle to the AHCI device. |
1cd1031d | 154 | */ |
debaaa11 | 155 | static AHCIQState *ahci_vboot(const char *cli, va_list ap) |
1cd1031d | 156 | { |
dd0029c0 | 157 | AHCIQState *s; |
1cd1031d | 158 | |
790bbb97 | 159 | s = g_new0(AHCIQState, 1); |
debaaa11 | 160 | s->parent = qtest_pc_vboot(cli, ap); |
3d95fb97 | 161 | global_qtest = s->parent->qts; |
259342d3 | 162 | alloc_set_flags(s->parent->alloc, ALLOC_LEAK_ASSERT); |
1cd1031d | 163 | |
dd0029c0 | 164 | /* Verify that we have an AHCI device present. */ |
e5d1730d | 165 | s->dev = get_ahci_device(s->parent->qts, &s->fingerprint); |
1cd1031d | 166 | |
dd0029c0 | 167 | return s; |
1cd1031d JS |
168 | } |
169 | ||
debaaa11 JS |
170 | /** |
171 | * Start a Q35 machine and bookmark a handle to the AHCI device. | |
172 | */ | |
173 | static AHCIQState *ahci_boot(const char *cli, ...) | |
174 | { | |
175 | AHCIQState *s; | |
176 | va_list ap; | |
177 | ||
178 | if (cli) { | |
179 | va_start(ap, cli); | |
180 | s = ahci_vboot(cli, ap); | |
181 | va_end(ap); | |
182 | } else { | |
183 | cli = "-drive if=none,id=drive0,file=%s,cache=writeback,serial=%s" | |
b236b610 | 184 | ",format=%s" |
debaaa11 JS |
185 | " -M q35 " |
186 | "-device ide-hd,drive=drive0 " | |
187 | "-global ide-hd.ver=%s"; | |
b236b610 | 188 | s = ahci_boot(cli, tmp_path, "testdisk", imgfmt, "version"); |
debaaa11 JS |
189 | } |
190 | ||
191 | return s; | |
192 | } | |
193 | ||
1cd1031d JS |
194 | /** |
195 | * Clean up the PCI device, then terminate the QEMU instance. | |
196 | */ | |
dd0029c0 | 197 | static void ahci_shutdown(AHCIQState *ahci) |
1cd1031d | 198 | { |
dd0029c0 | 199 | QOSState *qs = ahci->parent; |
278128ab JS |
200 | |
201 | set_context(qs); | |
259342d3 | 202 | ahci_clean_mem(ahci); |
dd0029c0 JS |
203 | free_ahci_device(ahci->dev); |
204 | g_free(ahci); | |
205 | qtest_shutdown(qs); | |
1cd1031d JS |
206 | } |
207 | ||
d63b4017 JS |
208 | /** |
209 | * Boot and fully enable the HBA device. | |
210 | * @see ahci_boot, ahci_pci_enable and ahci_hba_enable. | |
211 | */ | |
debaaa11 | 212 | static AHCIQState *ahci_boot_and_enable(const char *cli, ...) |
d63b4017 JS |
213 | { |
214 | AHCIQState *ahci; | |
debaaa11 | 215 | va_list ap; |
34475239 JS |
216 | uint16_t buff[256]; |
217 | uint8_t port; | |
d0b282a5 | 218 | uint8_t hello; |
debaaa11 JS |
219 | |
220 | if (cli) { | |
221 | va_start(ap, cli); | |
222 | ahci = ahci_vboot(cli, ap); | |
223 | va_end(ap); | |
224 | } else { | |
225 | ahci = ahci_boot(NULL); | |
226 | } | |
d63b4017 JS |
227 | |
228 | ahci_pci_enable(ahci); | |
229 | ahci_hba_enable(ahci); | |
34475239 JS |
230 | /* Initialize test device */ |
231 | port = ahci_port_select(ahci); | |
232 | ahci_port_clear(ahci, port); | |
d0b282a5 JS |
233 | if (is_atapi(ahci, port)) { |
234 | hello = CMD_PACKET_ID; | |
235 | } else { | |
236 | hello = CMD_IDENTIFY; | |
237 | } | |
238 | ahci_io(ahci, port, hello, &buff, sizeof(buff), 0); | |
d63b4017 JS |
239 | |
240 | return ahci; | |
241 | } | |
242 | ||
8840a843 JS |
243 | /*** Specification Adherence Tests ***/ |
244 | ||
245 | /** | |
246 | * Implementation for test_pci_spec. Ensures PCI configuration space is sane. | |
247 | */ | |
6100ddb0 | 248 | static void ahci_test_pci_spec(AHCIQState *ahci) |
8840a843 JS |
249 | { |
250 | uint8_t datab; | |
251 | uint16_t data; | |
252 | uint32_t datal; | |
253 | ||
254 | /* Most of these bits should start cleared until we turn them on. */ | |
6100ddb0 | 255 | data = qpci_config_readw(ahci->dev, PCI_COMMAND); |
8840a843 JS |
256 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_MEMORY); |
257 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_MASTER); | |
258 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_SPECIAL); /* Reserved */ | |
259 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_VGA_PALETTE); /* Reserved */ | |
260 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_PARITY); | |
261 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_WAIT); /* Reserved */ | |
262 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_SERR); | |
263 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_FAST_BACK); | |
264 | ASSERT_BIT_CLEAR(data, PCI_COMMAND_INTX_DISABLE); | |
265 | ASSERT_BIT_CLEAR(data, 0xF800); /* Reserved */ | |
266 | ||
6100ddb0 | 267 | data = qpci_config_readw(ahci->dev, PCI_STATUS); |
8840a843 JS |
268 | ASSERT_BIT_CLEAR(data, 0x01 | 0x02 | 0x04); /* Reserved */ |
269 | ASSERT_BIT_CLEAR(data, PCI_STATUS_INTERRUPT); | |
270 | ASSERT_BIT_SET(data, PCI_STATUS_CAP_LIST); /* must be set */ | |
271 | ASSERT_BIT_CLEAR(data, PCI_STATUS_UDF); /* Reserved */ | |
272 | ASSERT_BIT_CLEAR(data, PCI_STATUS_PARITY); | |
273 | ASSERT_BIT_CLEAR(data, PCI_STATUS_SIG_TARGET_ABORT); | |
274 | ASSERT_BIT_CLEAR(data, PCI_STATUS_REC_TARGET_ABORT); | |
275 | ASSERT_BIT_CLEAR(data, PCI_STATUS_REC_MASTER_ABORT); | |
276 | ASSERT_BIT_CLEAR(data, PCI_STATUS_SIG_SYSTEM_ERROR); | |
277 | ASSERT_BIT_CLEAR(data, PCI_STATUS_DETECTED_PARITY); | |
278 | ||
279 | /* RID occupies the low byte, CCs occupy the high three. */ | |
6100ddb0 | 280 | datal = qpci_config_readl(ahci->dev, PCI_CLASS_REVISION); |
8840a843 JS |
281 | if (ahci_pedantic) { |
282 | /* AHCI 1.3 specifies that at-boot, the RID should reset to 0x00, | |
283 | * Though in practice this is likely seldom true. */ | |
284 | ASSERT_BIT_CLEAR(datal, 0xFF); | |
285 | } | |
286 | ||
287 | /* BCC *must* equal 0x01. */ | |
288 | g_assert_cmphex(PCI_BCC(datal), ==, 0x01); | |
289 | if (PCI_SCC(datal) == 0x01) { | |
290 | /* IDE */ | |
291 | ASSERT_BIT_SET(0x80000000, datal); | |
292 | ASSERT_BIT_CLEAR(0x60000000, datal); | |
293 | } else if (PCI_SCC(datal) == 0x04) { | |
294 | /* RAID */ | |
295 | g_assert_cmphex(PCI_PI(datal), ==, 0); | |
296 | } else if (PCI_SCC(datal) == 0x06) { | |
297 | /* AHCI */ | |
298 | g_assert_cmphex(PCI_PI(datal), ==, 0x01); | |
299 | } else { | |
300 | g_assert_not_reached(); | |
301 | } | |
302 | ||
6100ddb0 | 303 | datab = qpci_config_readb(ahci->dev, PCI_CACHE_LINE_SIZE); |
8840a843 JS |
304 | g_assert_cmphex(datab, ==, 0); |
305 | ||
6100ddb0 | 306 | datab = qpci_config_readb(ahci->dev, PCI_LATENCY_TIMER); |
8840a843 JS |
307 | g_assert_cmphex(datab, ==, 0); |
308 | ||
309 | /* Only the bottom 7 bits must be off. */ | |
6100ddb0 | 310 | datab = qpci_config_readb(ahci->dev, PCI_HEADER_TYPE); |
8840a843 JS |
311 | ASSERT_BIT_CLEAR(datab, 0x7F); |
312 | ||
313 | /* BIST is optional, but the low 7 bits must always start off regardless. */ | |
6100ddb0 | 314 | datab = qpci_config_readb(ahci->dev, PCI_BIST); |
8840a843 JS |
315 | ASSERT_BIT_CLEAR(datab, 0x7F); |
316 | ||
317 | /* BARS 0-4 do not have a boot spec, but ABAR/BAR5 must be clean. */ | |
6100ddb0 | 318 | datal = qpci_config_readl(ahci->dev, PCI_BASE_ADDRESS_5); |
8840a843 JS |
319 | g_assert_cmphex(datal, ==, 0); |
320 | ||
6100ddb0 JS |
321 | qpci_config_writel(ahci->dev, PCI_BASE_ADDRESS_5, 0xFFFFFFFF); |
322 | datal = qpci_config_readl(ahci->dev, PCI_BASE_ADDRESS_5); | |
8840a843 JS |
323 | /* ABAR must be 32-bit, memory mapped, non-prefetchable and |
324 | * must be >= 512 bytes. To that end, bits 0-8 must be off. */ | |
325 | ASSERT_BIT_CLEAR(datal, 0xFF); | |
326 | ||
327 | /* Capability list MUST be present, */ | |
6100ddb0 | 328 | datal = qpci_config_readl(ahci->dev, PCI_CAPABILITY_LIST); |
8840a843 JS |
329 | /* But these bits are reserved. */ |
330 | ASSERT_BIT_CLEAR(datal, ~0xFF); | |
331 | g_assert_cmphex(datal, !=, 0); | |
332 | ||
333 | /* Check specification adherence for capability extenstions. */ | |
6100ddb0 | 334 | data = qpci_config_readw(ahci->dev, datal); |
8840a843 | 335 | |
8d5eeced | 336 | switch (ahci->fingerprint) { |
8840a843 JS |
337 | case AHCI_INTEL_ICH9: |
338 | /* Intel ICH9 Family Datasheet 14.1.19 p.550 */ | |
339 | g_assert_cmphex((data & 0xFF), ==, PCI_CAP_ID_MSI); | |
340 | break; | |
341 | default: | |
342 | /* AHCI 1.3, Section 2.1.14 -- CAP must point to PMCAP. */ | |
343 | g_assert_cmphex((data & 0xFF), ==, PCI_CAP_ID_PM); | |
344 | } | |
345 | ||
346 | ahci_test_pci_caps(ahci, data, (uint8_t)datal); | |
347 | ||
348 | /* Reserved. */ | |
6100ddb0 | 349 | datal = qpci_config_readl(ahci->dev, PCI_CAPABILITY_LIST + 4); |
8840a843 JS |
350 | g_assert_cmphex(datal, ==, 0); |
351 | ||
352 | /* IPIN might vary, but ILINE must be off. */ | |
6100ddb0 | 353 | datab = qpci_config_readb(ahci->dev, PCI_INTERRUPT_LINE); |
8840a843 JS |
354 | g_assert_cmphex(datab, ==, 0); |
355 | } | |
356 | ||
357 | /** | |
358 | * Test PCI capabilities for AHCI specification adherence. | |
359 | */ | |
6100ddb0 | 360 | static void ahci_test_pci_caps(AHCIQState *ahci, uint16_t header, |
8840a843 JS |
361 | uint8_t offset) |
362 | { | |
363 | uint8_t cid = header & 0xFF; | |
364 | uint8_t next = header >> 8; | |
365 | ||
366 | g_test_message("CID: %02x; next: %02x", cid, next); | |
367 | ||
368 | switch (cid) { | |
369 | case PCI_CAP_ID_PM: | |
370 | ahci_test_pmcap(ahci, offset); | |
371 | break; | |
372 | case PCI_CAP_ID_MSI: | |
373 | ahci_test_msicap(ahci, offset); | |
374 | break; | |
375 | case PCI_CAP_ID_SATA: | |
376 | ahci_test_satacap(ahci, offset); | |
377 | break; | |
378 | ||
379 | default: | |
380 | g_test_message("Unknown CAP 0x%02x", cid); | |
381 | } | |
382 | ||
383 | if (next) { | |
6100ddb0 | 384 | ahci_test_pci_caps(ahci, qpci_config_readw(ahci->dev, next), next); |
8840a843 JS |
385 | } |
386 | } | |
387 | ||
388 | /** | |
389 | * Test SATA PCI capabilitity for AHCI specification adherence. | |
390 | */ | |
6100ddb0 | 391 | static void ahci_test_satacap(AHCIQState *ahci, uint8_t offset) |
8840a843 JS |
392 | { |
393 | uint16_t dataw; | |
394 | uint32_t datal; | |
395 | ||
396 | g_test_message("Verifying SATACAP"); | |
397 | ||
398 | /* Assert that the SATACAP version is 1.0, And reserved bits are empty. */ | |
6100ddb0 | 399 | dataw = qpci_config_readw(ahci->dev, offset + 2); |
8840a843 JS |
400 | g_assert_cmphex(dataw, ==, 0x10); |
401 | ||
402 | /* Grab the SATACR1 register. */ | |
6100ddb0 | 403 | datal = qpci_config_readw(ahci->dev, offset + 4); |
8840a843 JS |
404 | |
405 | switch (datal & 0x0F) { | |
406 | case 0x04: /* BAR0 */ | |
407 | case 0x05: /* BAR1 */ | |
408 | case 0x06: | |
409 | case 0x07: | |
410 | case 0x08: | |
411 | case 0x09: /* BAR5 */ | |
412 | case 0x0F: /* Immediately following SATACR1 in PCI config space. */ | |
413 | break; | |
414 | default: | |
415 | /* Invalid BARLOC for the Index Data Pair. */ | |
416 | g_assert_not_reached(); | |
417 | } | |
418 | ||
419 | /* Reserved. */ | |
420 | g_assert_cmphex((datal >> 24), ==, 0x00); | |
421 | } | |
422 | ||
423 | /** | |
424 | * Test MSI PCI capability for AHCI specification adherence. | |
425 | */ | |
6100ddb0 | 426 | static void ahci_test_msicap(AHCIQState *ahci, uint8_t offset) |
8840a843 JS |
427 | { |
428 | uint16_t dataw; | |
429 | uint32_t datal; | |
430 | ||
431 | g_test_message("Verifying MSICAP"); | |
432 | ||
6100ddb0 | 433 | dataw = qpci_config_readw(ahci->dev, offset + PCI_MSI_FLAGS); |
8840a843 JS |
434 | ASSERT_BIT_CLEAR(dataw, PCI_MSI_FLAGS_ENABLE); |
435 | ASSERT_BIT_CLEAR(dataw, PCI_MSI_FLAGS_QSIZE); | |
436 | ASSERT_BIT_CLEAR(dataw, PCI_MSI_FLAGS_RESERVED); | |
437 | ||
6100ddb0 | 438 | datal = qpci_config_readl(ahci->dev, offset + PCI_MSI_ADDRESS_LO); |
8840a843 JS |
439 | g_assert_cmphex(datal, ==, 0); |
440 | ||
441 | if (dataw & PCI_MSI_FLAGS_64BIT) { | |
442 | g_test_message("MSICAP is 64bit"); | |
6100ddb0 | 443 | datal = qpci_config_readl(ahci->dev, offset + PCI_MSI_ADDRESS_HI); |
8840a843 | 444 | g_assert_cmphex(datal, ==, 0); |
6100ddb0 | 445 | dataw = qpci_config_readw(ahci->dev, offset + PCI_MSI_DATA_64); |
8840a843 JS |
446 | g_assert_cmphex(dataw, ==, 0); |
447 | } else { | |
448 | g_test_message("MSICAP is 32bit"); | |
6100ddb0 | 449 | dataw = qpci_config_readw(ahci->dev, offset + PCI_MSI_DATA_32); |
8840a843 JS |
450 | g_assert_cmphex(dataw, ==, 0); |
451 | } | |
452 | } | |
453 | ||
454 | /** | |
455 | * Test Power Management PCI capability for AHCI specification adherence. | |
456 | */ | |
6100ddb0 | 457 | static void ahci_test_pmcap(AHCIQState *ahci, uint8_t offset) |
8840a843 JS |
458 | { |
459 | uint16_t dataw; | |
460 | ||
461 | g_test_message("Verifying PMCAP"); | |
462 | ||
6100ddb0 | 463 | dataw = qpci_config_readw(ahci->dev, offset + PCI_PM_PMC); |
8840a843 JS |
464 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CAP_PME_CLOCK); |
465 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CAP_RESERVED); | |
466 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CAP_D1); | |
467 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CAP_D2); | |
468 | ||
6100ddb0 | 469 | dataw = qpci_config_readw(ahci->dev, offset + PCI_PM_CTRL); |
8840a843 JS |
470 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CTRL_STATE_MASK); |
471 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CTRL_RESERVED); | |
472 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CTRL_DATA_SEL_MASK); | |
473 | ASSERT_BIT_CLEAR(dataw, PCI_PM_CTRL_DATA_SCALE_MASK); | |
474 | } | |
475 | ||
6100ddb0 | 476 | static void ahci_test_hba_spec(AHCIQState *ahci) |
c2f3029f | 477 | { |
c2f3029f | 478 | unsigned i; |
8d5eeced | 479 | uint32_t reg; |
c2f3029f JS |
480 | uint32_t ports; |
481 | uint8_t nports_impl; | |
482 | uint8_t maxports; | |
483 | ||
6100ddb0 | 484 | g_assert(ahci != NULL); |
c2f3029f JS |
485 | |
486 | /* | |
487 | * Note that the AHCI spec does expect the BIOS to set up a few things: | |
488 | * CAP.SSS - Support for staggered spin-up (t/f) | |
489 | * CAP.SMPS - Support for mechanical presence switches (t/f) | |
490 | * PI - Ports Implemented (1-32) | |
491 | * PxCMD.HPCP - Hot Plug Capable Port | |
492 | * PxCMD.MPSP - Mechanical Presence Switch Present | |
493 | * PxCMD.CPD - Cold Presence Detection support | |
494 | * | |
495 | * Additional items are touched if CAP.SSS is on, see AHCI 10.1.1 p.97: | |
496 | * Foreach Port Implemented: | |
497 | * -PxCMD.ST, PxCMD.CR, PxCMD.FRE, PxCMD.FR, PxSCTL.DET are 0 | |
498 | * -PxCLB/U and PxFB/U are set to valid regions in memory | |
499 | * -PxSUD is set to 1. | |
500 | * -PxSSTS.DET is polled for presence; if detected, we continue: | |
501 | * -PxSERR is cleared with 1's. | |
502 | * -If PxTFD.STS.BSY, PxTFD.STS.DRQ, and PxTFD.STS.ERR are all zero, | |
503 | * the device is ready. | |
504 | */ | |
505 | ||
506 | /* 1 CAP - Capabilities Register */ | |
1a8bba4d | 507 | ahci->cap = ahci_rreg(ahci, AHCI_CAP); |
8d5eeced | 508 | ASSERT_BIT_CLEAR(ahci->cap, AHCI_CAP_RESERVED); |
c2f3029f JS |
509 | |
510 | /* 2 GHC - Global Host Control */ | |
1a8bba4d | 511 | reg = ahci_rreg(ahci, AHCI_GHC); |
c2f3029f JS |
512 | ASSERT_BIT_CLEAR(reg, AHCI_GHC_HR); |
513 | ASSERT_BIT_CLEAR(reg, AHCI_GHC_IE); | |
514 | ASSERT_BIT_CLEAR(reg, AHCI_GHC_MRSM); | |
8d5eeced | 515 | if (BITSET(ahci->cap, AHCI_CAP_SAM)) { |
c2f3029f JS |
516 | g_test_message("Supports AHCI-Only Mode: GHC_AE is Read-Only."); |
517 | ASSERT_BIT_SET(reg, AHCI_GHC_AE); | |
518 | } else { | |
519 | g_test_message("Supports AHCI/Legacy mix."); | |
520 | ASSERT_BIT_CLEAR(reg, AHCI_GHC_AE); | |
521 | } | |
522 | ||
523 | /* 3 IS - Interrupt Status */ | |
1a8bba4d | 524 | reg = ahci_rreg(ahci, AHCI_IS); |
c2f3029f JS |
525 | g_assert_cmphex(reg, ==, 0); |
526 | ||
527 | /* 4 PI - Ports Implemented */ | |
1a8bba4d | 528 | ports = ahci_rreg(ahci, AHCI_PI); |
c2f3029f JS |
529 | /* Ports Implemented must be non-zero. */ |
530 | g_assert_cmphex(ports, !=, 0); | |
531 | /* Ports Implemented must be <= Number of Ports. */ | |
532 | nports_impl = ctpopl(ports); | |
8d5eeced | 533 | g_assert_cmpuint(((AHCI_CAP_NP & ahci->cap) + 1), >=, nports_impl); |
c2f3029f | 534 | |
c2f3029f JS |
535 | /* Ports must be within the proper range. Given a mapping of SIZE, |
536 | * 256 bytes are used for global HBA control, and the rest is used | |
537 | * for ports data, at 0x80 bytes each. */ | |
8d5eeced JS |
538 | g_assert_cmphex(ahci->barsize, >, 0); |
539 | maxports = (ahci->barsize - HBA_DATA_REGION_SIZE) / HBA_PORT_DATA_SIZE; | |
c2f3029f JS |
540 | /* e.g, 30 ports for 4K of memory. (4096 - 256) / 128 = 30 */ |
541 | g_assert_cmphex((reg >> maxports), ==, 0); | |
542 | ||
543 | /* 5 AHCI Version */ | |
1a8bba4d | 544 | reg = ahci_rreg(ahci, AHCI_VS); |
c2f3029f JS |
545 | switch (reg) { |
546 | case AHCI_VERSION_0_95: | |
547 | case AHCI_VERSION_1_0: | |
548 | case AHCI_VERSION_1_1: | |
549 | case AHCI_VERSION_1_2: | |
550 | case AHCI_VERSION_1_3: | |
551 | break; | |
552 | default: | |
553 | g_assert_not_reached(); | |
554 | } | |
555 | ||
556 | /* 6 Command Completion Coalescing Control: depends on CAP.CCCS. */ | |
1a8bba4d | 557 | reg = ahci_rreg(ahci, AHCI_CCCCTL); |
8d5eeced | 558 | if (BITSET(ahci->cap, AHCI_CAP_CCCS)) { |
c2f3029f JS |
559 | ASSERT_BIT_CLEAR(reg, AHCI_CCCCTL_EN); |
560 | ASSERT_BIT_CLEAR(reg, AHCI_CCCCTL_RESERVED); | |
561 | ASSERT_BIT_SET(reg, AHCI_CCCCTL_CC); | |
562 | ASSERT_BIT_SET(reg, AHCI_CCCCTL_TV); | |
563 | } else { | |
564 | g_assert_cmphex(reg, ==, 0); | |
565 | } | |
566 | ||
567 | /* 7 CCC_PORTS */ | |
1a8bba4d | 568 | reg = ahci_rreg(ahci, AHCI_CCCPORTS); |
c2f3029f JS |
569 | /* Must be zeroes initially regardless of CAP.CCCS */ |
570 | g_assert_cmphex(reg, ==, 0); | |
571 | ||
572 | /* 8 EM_LOC */ | |
1a8bba4d | 573 | reg = ahci_rreg(ahci, AHCI_EMLOC); |
8d5eeced | 574 | if (BITCLR(ahci->cap, AHCI_CAP_EMS)) { |
c2f3029f JS |
575 | g_assert_cmphex(reg, ==, 0); |
576 | } | |
577 | ||
578 | /* 9 EM_CTL */ | |
1a8bba4d | 579 | reg = ahci_rreg(ahci, AHCI_EMCTL); |
8d5eeced | 580 | if (BITSET(ahci->cap, AHCI_CAP_EMS)) { |
c2f3029f JS |
581 | ASSERT_BIT_CLEAR(reg, AHCI_EMCTL_STSMR); |
582 | ASSERT_BIT_CLEAR(reg, AHCI_EMCTL_CTLTM); | |
583 | ASSERT_BIT_CLEAR(reg, AHCI_EMCTL_CTLRST); | |
584 | ASSERT_BIT_CLEAR(reg, AHCI_EMCTL_RESERVED); | |
585 | } else { | |
586 | g_assert_cmphex(reg, ==, 0); | |
587 | } | |
588 | ||
589 | /* 10 CAP2 -- Capabilities Extended */ | |
1a8bba4d | 590 | ahci->cap2 = ahci_rreg(ahci, AHCI_CAP2); |
8d5eeced | 591 | ASSERT_BIT_CLEAR(ahci->cap2, AHCI_CAP2_RESERVED); |
c2f3029f JS |
592 | |
593 | /* 11 BOHC -- Bios/OS Handoff Control */ | |
1a8bba4d | 594 | reg = ahci_rreg(ahci, AHCI_BOHC); |
c2f3029f JS |
595 | g_assert_cmphex(reg, ==, 0); |
596 | ||
597 | /* 12 -- 23: Reserved */ | |
598 | g_test_message("Verifying HBA reserved area is empty."); | |
599 | for (i = AHCI_RESERVED; i < AHCI_NVMHCI; ++i) { | |
1a8bba4d | 600 | reg = ahci_rreg(ahci, i); |
c2f3029f JS |
601 | g_assert_cmphex(reg, ==, 0); |
602 | } | |
603 | ||
604 | /* 24 -- 39: NVMHCI */ | |
8d5eeced | 605 | if (BITCLR(ahci->cap2, AHCI_CAP2_NVMP)) { |
c2f3029f JS |
606 | g_test_message("Verifying HBA/NVMHCI area is empty."); |
607 | for (i = AHCI_NVMHCI; i < AHCI_VENDOR; ++i) { | |
1a8bba4d | 608 | reg = ahci_rreg(ahci, i); |
c2f3029f JS |
609 | g_assert_cmphex(reg, ==, 0); |
610 | } | |
611 | } | |
612 | ||
613 | /* 40 -- 63: Vendor */ | |
614 | g_test_message("Verifying HBA/Vendor area is empty."); | |
615 | for (i = AHCI_VENDOR; i < AHCI_PORTS; ++i) { | |
1a8bba4d | 616 | reg = ahci_rreg(ahci, i); |
c2f3029f JS |
617 | g_assert_cmphex(reg, ==, 0); |
618 | } | |
619 | ||
620 | /* 64 -- XX: Port Space */ | |
c2f3029f JS |
621 | for (i = 0; ports || (i < maxports); ports >>= 1, ++i) { |
622 | if (BITSET(ports, 0x1)) { | |
623 | g_test_message("Testing port %u for spec", i); | |
8d5eeced | 624 | ahci_test_port_spec(ahci, i); |
c2f3029f JS |
625 | } else { |
626 | uint16_t j; | |
627 | uint16_t low = AHCI_PORTS + (32 * i); | |
628 | uint16_t high = AHCI_PORTS + (32 * (i + 1)); | |
629 | g_test_message("Asserting unimplemented port %u " | |
630 | "(reg [%u-%u]) is empty.", | |
631 | i, low, high - 1); | |
632 | for (j = low; j < high; ++j) { | |
1a8bba4d | 633 | reg = ahci_rreg(ahci, j); |
c2f3029f JS |
634 | g_assert_cmphex(reg, ==, 0); |
635 | } | |
636 | } | |
637 | } | |
638 | } | |
639 | ||
640 | /** | |
641 | * Test the memory space for one port for specification adherence. | |
642 | */ | |
8d5eeced | 643 | static void ahci_test_port_spec(AHCIQState *ahci, uint8_t port) |
c2f3029f JS |
644 | { |
645 | uint32_t reg; | |
646 | unsigned i; | |
647 | ||
648 | /* (0) CLB */ | |
1a8bba4d | 649 | reg = ahci_px_rreg(ahci, port, AHCI_PX_CLB); |
c2f3029f JS |
650 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CLB_RESERVED); |
651 | ||
652 | /* (1) CLBU */ | |
8d5eeced | 653 | if (BITCLR(ahci->cap, AHCI_CAP_S64A)) { |
1a8bba4d | 654 | reg = ahci_px_rreg(ahci, port, AHCI_PX_CLBU); |
c2f3029f JS |
655 | g_assert_cmphex(reg, ==, 0); |
656 | } | |
657 | ||
658 | /* (2) FB */ | |
1a8bba4d | 659 | reg = ahci_px_rreg(ahci, port, AHCI_PX_FB); |
c2f3029f JS |
660 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FB_RESERVED); |
661 | ||
662 | /* (3) FBU */ | |
8d5eeced | 663 | if (BITCLR(ahci->cap, AHCI_CAP_S64A)) { |
1a8bba4d | 664 | reg = ahci_px_rreg(ahci, port, AHCI_PX_FBU); |
c2f3029f JS |
665 | g_assert_cmphex(reg, ==, 0); |
666 | } | |
667 | ||
668 | /* (4) IS */ | |
1a8bba4d | 669 | reg = ahci_px_rreg(ahci, port, AHCI_PX_IS); |
c2f3029f JS |
670 | g_assert_cmphex(reg, ==, 0); |
671 | ||
672 | /* (5) IE */ | |
1a8bba4d | 673 | reg = ahci_px_rreg(ahci, port, AHCI_PX_IE); |
c2f3029f JS |
674 | g_assert_cmphex(reg, ==, 0); |
675 | ||
676 | /* (6) CMD */ | |
1a8bba4d | 677 | reg = ahci_px_rreg(ahci, port, AHCI_PX_CMD); |
c2f3029f JS |
678 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_FRE); |
679 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_RESERVED); | |
680 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_CCS); | |
681 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_FR); | |
682 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_CR); | |
683 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_PMA); /* And RW only if CAP.SPM */ | |
684 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_APSTE); /* RW only if CAP2.APST */ | |
685 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_ATAPI); | |
686 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_DLAE); | |
687 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_ALPE); /* RW only if CAP.SALP */ | |
688 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_ASP); /* RW only if CAP.SALP */ | |
689 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_ICC); | |
690 | /* If CPDetect support does not exist, CPState must be off. */ | |
691 | if (BITCLR(reg, AHCI_PX_CMD_CPD)) { | |
692 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_CPS); | |
693 | } | |
694 | /* If MPSPresence is not set, MPSState must be off. */ | |
695 | if (BITCLR(reg, AHCI_PX_CMD_MPSP)) { | |
696 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_MPSS); | |
697 | } | |
698 | /* If we do not support MPS, MPSS and MPSP must be off. */ | |
8d5eeced | 699 | if (BITCLR(ahci->cap, AHCI_CAP_SMPS)) { |
c2f3029f JS |
700 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_MPSS); |
701 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_MPSP); | |
702 | } | |
703 | /* If, via CPD or MPSP we detect a drive, HPCP must be on. */ | |
7e7d49d6 | 704 | if (BITANY(reg, AHCI_PX_CMD_CPD | AHCI_PX_CMD_MPSP)) { |
c2f3029f JS |
705 | ASSERT_BIT_SET(reg, AHCI_PX_CMD_HPCP); |
706 | } | |
707 | /* HPCP and ESP cannot both be active. */ | |
708 | g_assert(!BITSET(reg, AHCI_PX_CMD_HPCP | AHCI_PX_CMD_ESP)); | |
709 | /* If CAP.FBSS is not set, FBSCP must not be set. */ | |
8d5eeced | 710 | if (BITCLR(ahci->cap, AHCI_CAP_FBSS)) { |
c2f3029f JS |
711 | ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_FBSCP); |
712 | } | |
713 | ||
714 | /* (7) RESERVED */ | |
1a8bba4d | 715 | reg = ahci_px_rreg(ahci, port, AHCI_PX_RES1); |
c2f3029f JS |
716 | g_assert_cmphex(reg, ==, 0); |
717 | ||
718 | /* (8) TFD */ | |
1a8bba4d | 719 | reg = ahci_px_rreg(ahci, port, AHCI_PX_TFD); |
c2f3029f JS |
720 | /* At boot, prior to an FIS being received, the TFD register should be 0x7F, |
721 | * which breaks down as follows, as seen in AHCI 1.3 sec 3.3.8, p. 27. */ | |
722 | ASSERT_BIT_SET(reg, AHCI_PX_TFD_STS_ERR); | |
723 | ASSERT_BIT_SET(reg, AHCI_PX_TFD_STS_CS1); | |
724 | ASSERT_BIT_SET(reg, AHCI_PX_TFD_STS_DRQ); | |
725 | ASSERT_BIT_SET(reg, AHCI_PX_TFD_STS_CS2); | |
726 | ASSERT_BIT_CLEAR(reg, AHCI_PX_TFD_STS_BSY); | |
727 | ASSERT_BIT_CLEAR(reg, AHCI_PX_TFD_ERR); | |
728 | ASSERT_BIT_CLEAR(reg, AHCI_PX_TFD_RESERVED); | |
729 | ||
730 | /* (9) SIG */ | |
731 | /* Though AHCI specifies the boot value should be 0xFFFFFFFF, | |
732 | * Even when GHC.ST is zero, the AHCI HBA may receive the initial | |
733 | * D2H register FIS and update the signature asynchronously, | |
734 | * so we cannot expect a value here. AHCI 1.3, sec 3.3.9, pp 27-28 */ | |
735 | ||
736 | /* (10) SSTS / SCR0: SStatus */ | |
1a8bba4d | 737 | reg = ahci_px_rreg(ahci, port, AHCI_PX_SSTS); |
c2f3029f JS |
738 | ASSERT_BIT_CLEAR(reg, AHCI_PX_SSTS_RESERVED); |
739 | /* Even though the register should be 0 at boot, it is asynchronous and | |
740 | * prone to change, so we cannot test any well known value. */ | |
741 | ||
742 | /* (11) SCTL / SCR2: SControl */ | |
1a8bba4d | 743 | reg = ahci_px_rreg(ahci, port, AHCI_PX_SCTL); |
c2f3029f JS |
744 | g_assert_cmphex(reg, ==, 0); |
745 | ||
746 | /* (12) SERR / SCR1: SError */ | |
1a8bba4d | 747 | reg = ahci_px_rreg(ahci, port, AHCI_PX_SERR); |
c2f3029f JS |
748 | g_assert_cmphex(reg, ==, 0); |
749 | ||
750 | /* (13) SACT / SCR3: SActive */ | |
1a8bba4d | 751 | reg = ahci_px_rreg(ahci, port, AHCI_PX_SACT); |
c2f3029f JS |
752 | g_assert_cmphex(reg, ==, 0); |
753 | ||
754 | /* (14) CI */ | |
1a8bba4d | 755 | reg = ahci_px_rreg(ahci, port, AHCI_PX_CI); |
c2f3029f JS |
756 | g_assert_cmphex(reg, ==, 0); |
757 | ||
758 | /* (15) SNTF */ | |
1a8bba4d | 759 | reg = ahci_px_rreg(ahci, port, AHCI_PX_SNTF); |
c2f3029f JS |
760 | g_assert_cmphex(reg, ==, 0); |
761 | ||
762 | /* (16) FBS */ | |
1a8bba4d | 763 | reg = ahci_px_rreg(ahci, port, AHCI_PX_FBS); |
c2f3029f JS |
764 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FBS_EN); |
765 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FBS_DEC); | |
766 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FBS_SDE); | |
767 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FBS_DEV); | |
768 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FBS_DWE); | |
769 | ASSERT_BIT_CLEAR(reg, AHCI_PX_FBS_RESERVED); | |
8d5eeced | 770 | if (BITSET(ahci->cap, AHCI_CAP_FBSS)) { |
c2f3029f JS |
771 | /* if Port-Multiplier FIS-based switching avail, ADO must >= 2 */ |
772 | g_assert((reg & AHCI_PX_FBS_ADO) >> ctzl(AHCI_PX_FBS_ADO) >= 2); | |
773 | } | |
774 | ||
775 | /* [17 -- 27] RESERVED */ | |
776 | for (i = AHCI_PX_RES2; i < AHCI_PX_VS; ++i) { | |
1a8bba4d | 777 | reg = ahci_px_rreg(ahci, port, i); |
c2f3029f JS |
778 | g_assert_cmphex(reg, ==, 0); |
779 | } | |
780 | ||
781 | /* [28 -- 31] Vendor-Specific */ | |
782 | for (i = AHCI_PX_VS; i < 32; ++i) { | |
1a8bba4d | 783 | reg = ahci_px_rreg(ahci, port, i); |
c2f3029f JS |
784 | if (reg) { |
785 | g_test_message("INFO: Vendor register %u non-empty", i); | |
786 | } | |
787 | } | |
788 | } | |
789 | ||
0fa781e3 JS |
790 | /** |
791 | * Utilizing an initialized AHCI HBA, issue an IDENTIFY command to the first | |
792 | * device we see, then read and check the response. | |
793 | */ | |
6100ddb0 | 794 | static void ahci_test_identify(AHCIQState *ahci) |
0fa781e3 | 795 | { |
0fa781e3 | 796 | uint16_t buff[256]; |
ae029620 | 797 | unsigned px; |
0fa781e3 | 798 | int rc; |
122482a3 | 799 | uint16_t sect_size; |
ae029620 | 800 | const size_t buffsize = 512; |
0fa781e3 JS |
801 | |
802 | g_assert(ahci != NULL); | |
0fa781e3 | 803 | |
ae029620 JS |
804 | /** |
805 | * This serves as a bit of a tutorial on AHCI device programming: | |
806 | * | |
807 | * (1) Create a data buffer for the IDENTIFY response to be sent to | |
808 | * (2) Create a Command Table buffer, where we will store the | |
809 | * command and PRDT (Physical Region Descriptor Table) | |
64a5a272 | 810 | * (3) Construct an FIS host-to-device command structure, and write it to |
ae029620 JS |
811 | * the top of the Command Table buffer. |
812 | * (4) Create one or more Physical Region Descriptors (PRDs) that describe | |
813 | * a location in memory where data may be stored/retrieved. | |
814 | * (5) Write these PRDTs to the bottom (offset 0x80) of the Command Table. | |
815 | * (6) Each AHCI port has up to 32 command slots. Each slot contains a | |
816 | * header that points to a Command Table buffer. Pick an unused slot | |
817 | * and update it to point to the Command Table we have built. | |
818 | * (7) Now: Command #n points to our Command Table, and our Command Table | |
819 | * contains the FIS (that describes our command) and the PRDTL, which | |
820 | * describes our buffer. | |
821 | * (8) We inform the HBA via PxCI (Command Issue) that the command in slot | |
822 | * #n is ready for processing. | |
0fa781e3 JS |
823 | */ |
824 | ||
825 | /* Pick the first implemented and running port */ | |
ae029620 JS |
826 | px = ahci_port_select(ahci); |
827 | g_test_message("Selected port %u for test", px); | |
0fa781e3 | 828 | |
e83fd96b | 829 | /* Clear out the FIS Receive area and any pending interrupts. */ |
ae029620 | 830 | ahci_port_clear(ahci, px); |
0fa781e3 | 831 | |
ae029620 | 832 | /* "Read" 512 bytes using CMD_IDENTIFY into the host buffer. */ |
727be1a7 | 833 | ahci_io(ahci, px, CMD_IDENTIFY, &buff, buffsize, 0); |
0fa781e3 JS |
834 | |
835 | /* Check serial number/version in the buffer */ | |
836 | /* NB: IDENTIFY strings are packed in 16bit little endian chunks. | |
837 | * Since we copy byte-for-byte in ahci-test, on both LE and BE, we need to | |
838 | * unchunk this data. By contrast, ide-test copies 2 bytes at a time, and | |
839 | * as a consequence, only needs to unchunk the data on LE machines. */ | |
840 | string_bswap16(&buff[10], 20); | |
841 | rc = memcmp(&buff[10], "testdisk ", 20); | |
842 | g_assert_cmphex(rc, ==, 0); | |
843 | ||
844 | string_bswap16(&buff[23], 8); | |
845 | rc = memcmp(&buff[23], "version ", 8); | |
846 | g_assert_cmphex(rc, ==, 0); | |
122482a3 JS |
847 | |
848 | sect_size = le16_to_cpu(*((uint16_t *)(&buff[5]))); | |
727be1a7 | 849 | g_assert_cmphex(sect_size, ==, AHCI_SECTOR_SIZE); |
0fa781e3 JS |
850 | } |
851 | ||
bda39dc2 | 852 | static void ahci_test_io_rw_simple(AHCIQState *ahci, unsigned bufsize, |
727be1a7 JS |
853 | uint64_t sector, uint8_t read_cmd, |
854 | uint8_t write_cmd) | |
81705ee4 JS |
855 | { |
856 | uint64_t ptr; | |
857 | uint8_t port; | |
81705ee4 JS |
858 | unsigned char *tx = g_malloc(bufsize); |
859 | unsigned char *rx = g_malloc0(bufsize); | |
860 | ||
861 | g_assert(ahci != NULL); | |
862 | ||
863 | /* Pick the first running port and clear it. */ | |
864 | port = ahci_port_select(ahci); | |
865 | ahci_port_clear(ahci, port); | |
866 | ||
867 | /*** Create pattern and transfer to guest ***/ | |
868 | /* Data buffer in the guest */ | |
869 | ptr = ahci_alloc(ahci, bufsize); | |
870 | g_assert(ptr); | |
871 | ||
d6c403ed | 872 | /* Write some indicative pattern to our buffer. */ |
54fced03 | 873 | generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); |
91d0374a | 874 | bufwrite(ptr, tx, bufsize); |
81705ee4 JS |
875 | |
876 | /* Write this buffer to disk, then read it back to the DMA buffer. */ | |
727be1a7 | 877 | ahci_guest_io(ahci, port, write_cmd, ptr, bufsize, sector); |
81705ee4 | 878 | qmemset(ptr, 0x00, bufsize); |
727be1a7 | 879 | ahci_guest_io(ahci, port, read_cmd, ptr, bufsize, sector); |
81705ee4 JS |
880 | |
881 | /*** Read back the Data ***/ | |
91d0374a | 882 | bufread(ptr, rx, bufsize); |
81705ee4 JS |
883 | g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); |
884 | ||
885 | ahci_free(ahci, ptr); | |
886 | g_free(tx); | |
887 | g_free(rx); | |
888 | } | |
889 | ||
0d3e9d1f | 890 | static uint8_t ahci_test_nondata(AHCIQState *ahci, uint8_t ide_cmd) |
4e217074 | 891 | { |
0d3e9d1f | 892 | uint8_t port; |
4e217074 JS |
893 | |
894 | /* Sanitize */ | |
0d3e9d1f JS |
895 | port = ahci_port_select(ahci); |
896 | ahci_port_clear(ahci, port); | |
4e217074 | 897 | |
b1b66c3b | 898 | ahci_io(ahci, port, ide_cmd, NULL, 0, 0); |
0d3e9d1f JS |
899 | |
900 | return port; | |
4e217074 JS |
901 | } |
902 | ||
903 | static void ahci_test_flush(AHCIQState *ahci) | |
904 | { | |
905 | ahci_test_nondata(ahci, CMD_FLUSH_CACHE); | |
906 | } | |
907 | ||
0d3e9d1f JS |
908 | static void ahci_test_max(AHCIQState *ahci) |
909 | { | |
910 | RegD2HFIS *d2h = g_malloc0(0x20); | |
911 | uint64_t nsect; | |
912 | uint8_t port; | |
913 | uint8_t cmd; | |
917158dc | 914 | uint64_t config_sect = mb_to_sectors(test_image_size_mb) - 1; |
0d3e9d1f JS |
915 | |
916 | if (config_sect > 0xFFFFFF) { | |
917 | cmd = CMD_READ_MAX_EXT; | |
918 | } else { | |
919 | cmd = CMD_READ_MAX; | |
920 | } | |
921 | ||
922 | port = ahci_test_nondata(ahci, cmd); | |
923 | memread(ahci->port[port].fb + 0x40, d2h, 0x20); | |
924 | nsect = (uint64_t)d2h->lba_hi[2] << 40 | | |
925 | (uint64_t)d2h->lba_hi[1] << 32 | | |
926 | (uint64_t)d2h->lba_hi[0] << 24 | | |
927 | (uint64_t)d2h->lba_lo[2] << 16 | | |
928 | (uint64_t)d2h->lba_lo[1] << 8 | | |
929 | (uint64_t)d2h->lba_lo[0]; | |
930 | ||
931 | g_assert_cmphex(nsect, ==, config_sect); | |
932 | g_free(d2h); | |
933 | } | |
934 | ||
4e217074 | 935 | |
1cd1031d JS |
936 | /******************************************************************************/ |
937 | /* Test Interfaces */ | |
938 | /******************************************************************************/ | |
939 | ||
940 | /** | |
941 | * Basic sanity test to boot a machine, find an AHCI device, and shutdown. | |
942 | */ | |
943 | static void test_sanity(void) | |
944 | { | |
dd0029c0 | 945 | AHCIQState *ahci; |
debaaa11 | 946 | ahci = ahci_boot(NULL); |
1cd1031d JS |
947 | ahci_shutdown(ahci); |
948 | } | |
949 | ||
8840a843 JS |
950 | /** |
951 | * Ensure that the PCI configuration space for the AHCI device is in-line with | |
952 | * the AHCI 1.3 specification for initial values. | |
953 | */ | |
954 | static void test_pci_spec(void) | |
955 | { | |
dd0029c0 | 956 | AHCIQState *ahci; |
debaaa11 | 957 | ahci = ahci_boot(NULL); |
6100ddb0 | 958 | ahci_test_pci_spec(ahci); |
8840a843 JS |
959 | ahci_shutdown(ahci); |
960 | } | |
961 | ||
96d6d3ba JS |
962 | /** |
963 | * Engage the PCI AHCI device and sanity check the response. | |
964 | * Perform additional PCI config space bringup for the HBA. | |
965 | */ | |
966 | static void test_pci_enable(void) | |
967 | { | |
dd0029c0 | 968 | AHCIQState *ahci; |
debaaa11 | 969 | ahci = ahci_boot(NULL); |
6100ddb0 | 970 | ahci_pci_enable(ahci); |
96d6d3ba JS |
971 | ahci_shutdown(ahci); |
972 | } | |
973 | ||
c2f3029f JS |
974 | /** |
975 | * Investigate the memory mapped regions of the HBA, | |
976 | * and test them for AHCI specification adherence. | |
977 | */ | |
978 | static void test_hba_spec(void) | |
979 | { | |
dd0029c0 | 980 | AHCIQState *ahci; |
c2f3029f | 981 | |
debaaa11 | 982 | ahci = ahci_boot(NULL); |
6100ddb0 JS |
983 | ahci_pci_enable(ahci); |
984 | ahci_test_hba_spec(ahci); | |
c2f3029f JS |
985 | ahci_shutdown(ahci); |
986 | } | |
987 | ||
dbc180e5 JS |
988 | /** |
989 | * Engage the HBA functionality of the AHCI PCI device, | |
990 | * and bring it into a functional idle state. | |
991 | */ | |
992 | static void test_hba_enable(void) | |
993 | { | |
dd0029c0 | 994 | AHCIQState *ahci; |
dbc180e5 | 995 | |
debaaa11 | 996 | ahci = ahci_boot(NULL); |
6100ddb0 JS |
997 | ahci_pci_enable(ahci); |
998 | ahci_hba_enable(ahci); | |
dbc180e5 JS |
999 | ahci_shutdown(ahci); |
1000 | } | |
1001 | ||
0fa781e3 JS |
1002 | /** |
1003 | * Bring up the device and issue an IDENTIFY command. | |
1004 | * Inspect the state of the HBA device and the data returned. | |
1005 | */ | |
1006 | static void test_identify(void) | |
1007 | { | |
dd0029c0 | 1008 | AHCIQState *ahci; |
0fa781e3 | 1009 | |
debaaa11 | 1010 | ahci = ahci_boot_and_enable(NULL); |
6100ddb0 | 1011 | ahci_test_identify(ahci); |
0fa781e3 JS |
1012 | ahci_shutdown(ahci); |
1013 | } | |
1014 | ||
e0c59cc7 JS |
1015 | /** |
1016 | * Fragmented DMA test: Perform a standard 4K DMA read/write | |
1017 | * test, but make sure the physical regions are fragmented to | |
1018 | * be very small, each just 32 bytes, to see how AHCI performs | |
1019 | * with chunks defined to be much less than a sector. | |
1020 | */ | |
1021 | static void test_dma_fragmented(void) | |
1022 | { | |
1023 | AHCIQState *ahci; | |
1024 | AHCICommand *cmd; | |
1025 | uint8_t px; | |
1026 | size_t bufsize = 4096; | |
1027 | unsigned char *tx = g_malloc(bufsize); | |
1028 | unsigned char *rx = g_malloc0(bufsize); | |
e0c59cc7 JS |
1029 | uint64_t ptr; |
1030 | ||
debaaa11 | 1031 | ahci = ahci_boot_and_enable(NULL); |
e0c59cc7 JS |
1032 | px = ahci_port_select(ahci); |
1033 | ahci_port_clear(ahci, px); | |
1034 | ||
1035 | /* create pattern */ | |
54fced03 | 1036 | generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); |
e0c59cc7 JS |
1037 | |
1038 | /* Create a DMA buffer in guest memory, and write our pattern to it. */ | |
1039 | ptr = guest_alloc(ahci->parent->alloc, bufsize); | |
1040 | g_assert(ptr); | |
91d0374a | 1041 | bufwrite(ptr, tx, bufsize); |
e0c59cc7 JS |
1042 | |
1043 | cmd = ahci_command_create(CMD_WRITE_DMA); | |
1044 | ahci_command_adjust(cmd, 0, ptr, bufsize, 32); | |
1045 | ahci_command_commit(ahci, cmd, px); | |
1046 | ahci_command_issue(ahci, cmd); | |
1047 | ahci_command_verify(ahci, cmd); | |
248de4a8 | 1048 | ahci_command_free(cmd); |
e0c59cc7 JS |
1049 | |
1050 | cmd = ahci_command_create(CMD_READ_DMA); | |
1051 | ahci_command_adjust(cmd, 0, ptr, bufsize, 32); | |
1052 | ahci_command_commit(ahci, cmd, px); | |
1053 | ahci_command_issue(ahci, cmd); | |
1054 | ahci_command_verify(ahci, cmd); | |
248de4a8 | 1055 | ahci_command_free(cmd); |
e0c59cc7 JS |
1056 | |
1057 | /* Read back the guest's receive buffer into local memory */ | |
91d0374a | 1058 | bufread(ptr, rx, bufsize); |
e0c59cc7 JS |
1059 | guest_free(ahci->parent->alloc, ptr); |
1060 | ||
1061 | g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); | |
1062 | ||
1063 | ahci_shutdown(ahci); | |
1064 | ||
1065 | g_free(rx); | |
1066 | g_free(tx); | |
1067 | } | |
1068 | ||
2dd7e10d EY |
1069 | /* |
1070 | * Write sector 1 with random data to make AHCI storage dirty | |
1071 | * Needed for flush tests so that flushes actually go though the block layer | |
1072 | */ | |
1073 | static void make_dirty(AHCIQState* ahci, uint8_t port) | |
1074 | { | |
1075 | uint64_t ptr; | |
1076 | unsigned bufsize = 512; | |
1077 | ||
1078 | ptr = ahci_alloc(ahci, bufsize); | |
1079 | g_assert(ptr); | |
1080 | ||
1081 | ahci_guest_io(ahci, port, CMD_WRITE_DMA, ptr, bufsize, 1); | |
1082 | ahci_free(ahci, ptr); | |
1083 | } | |
1084 | ||
4e217074 JS |
1085 | static void test_flush(void) |
1086 | { | |
1087 | AHCIQState *ahci; | |
2dd7e10d | 1088 | uint8_t port; |
4e217074 | 1089 | |
debaaa11 | 1090 | ahci = ahci_boot_and_enable(NULL); |
2dd7e10d EY |
1091 | |
1092 | port = ahci_port_select(ahci); | |
1093 | ahci_port_clear(ahci, port); | |
1094 | ||
1095 | make_dirty(ahci, port); | |
1096 | ||
4e217074 JS |
1097 | ahci_test_flush(ahci); |
1098 | ahci_shutdown(ahci); | |
1099 | } | |
1100 | ||
cf5aa89e JS |
1101 | static void test_flush_retry(void) |
1102 | { | |
1103 | AHCIQState *ahci; | |
1104 | AHCICommand *cmd; | |
1105 | uint8_t port; | |
cf5aa89e JS |
1106 | |
1107 | prepare_blkdebug_script(debug_path, "flush_to_disk"); | |
1108 | ahci = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," | |
b236b610 | 1109 | "format=%s,cache=writeback," |
cf5aa89e JS |
1110 | "rerror=stop,werror=stop " |
1111 | "-M q35 " | |
1112 | "-device ide-hd,drive=drive0 ", | |
1113 | debug_path, | |
b236b610 | 1114 | tmp_path, imgfmt); |
cf5aa89e | 1115 | |
cf5aa89e JS |
1116 | port = ahci_port_select(ahci); |
1117 | ahci_port_clear(ahci, port); | |
cf5aa89e | 1118 | |
2dd7e10d EY |
1119 | /* Issue write so that flush actually goes to disk */ |
1120 | make_dirty(ahci, port); | |
1121 | ||
1122 | /* Issue Flush Command and wait for error */ | |
b682d3a7 JS |
1123 | cmd = ahci_guest_io_halt(ahci, port, CMD_FLUSH_CACHE, 0, 0, 0); |
1124 | ahci_guest_io_resume(ahci, cmd); | |
1125 | ||
cf5aa89e JS |
1126 | ahci_shutdown(ahci); |
1127 | } | |
1128 | ||
278128ab JS |
1129 | /** |
1130 | * Basic sanity test to boot a machine, find an AHCI device, and shutdown. | |
1131 | */ | |
1132 | static void test_migrate_sanity(void) | |
1133 | { | |
1134 | AHCIQState *src, *dst; | |
6d9e7295 | 1135 | char *uri = g_strdup_printf("unix:%s", mig_socket); |
278128ab | 1136 | |
ff0ca962 | 1137 | src = ahci_boot("-m 384 -M q35 " |
b236b610 | 1138 | "-drive if=ide,file=%s,format=%s ", tmp_path, imgfmt); |
ff0ca962 | 1139 | dst = ahci_boot("-m 384 -M q35 " |
b236b610 JS |
1140 | "-drive if=ide,file=%s,format=%s " |
1141 | "-incoming %s", tmp_path, imgfmt, uri); | |
278128ab JS |
1142 | |
1143 | ahci_migrate(src, dst, uri); | |
1144 | ||
1145 | ahci_shutdown(src); | |
1146 | ahci_shutdown(dst); | |
6d9e7295 | 1147 | g_free(uri); |
278128ab JS |
1148 | } |
1149 | ||
88e21f94 | 1150 | /** |
07a1ee79 | 1151 | * Simple migration test: Write a pattern, migrate, then read. |
88e21f94 | 1152 | */ |
07a1ee79 | 1153 | static void ahci_migrate_simple(uint8_t cmd_read, uint8_t cmd_write) |
88e21f94 JS |
1154 | { |
1155 | AHCIQState *src, *dst; | |
1156 | uint8_t px; | |
1157 | size_t bufsize = 4096; | |
1158 | unsigned char *tx = g_malloc(bufsize); | |
1159 | unsigned char *rx = g_malloc0(bufsize); | |
6d9e7295 | 1160 | char *uri = g_strdup_printf("unix:%s", mig_socket); |
88e21f94 | 1161 | |
ff0ca962 | 1162 | src = ahci_boot_and_enable("-m 384 -M q35 " |
b236b610 JS |
1163 | "-drive if=ide,format=%s,file=%s ", |
1164 | imgfmt, tmp_path); | |
ff0ca962 | 1165 | dst = ahci_boot("-m 384 -M q35 " |
b236b610 JS |
1166 | "-drive if=ide,format=%s,file=%s " |
1167 | "-incoming %s", imgfmt, tmp_path, uri); | |
88e21f94 JS |
1168 | |
1169 | set_context(src->parent); | |
1170 | ||
1171 | /* initialize */ | |
1172 | px = ahci_port_select(src); | |
1173 | ahci_port_clear(src, px); | |
1174 | ||
1175 | /* create pattern */ | |
d7531638 | 1176 | generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); |
88e21f94 JS |
1177 | |
1178 | /* Write, migrate, then read. */ | |
07a1ee79 | 1179 | ahci_io(src, px, cmd_write, tx, bufsize, 0); |
88e21f94 | 1180 | ahci_migrate(src, dst, uri); |
07a1ee79 | 1181 | ahci_io(dst, px, cmd_read, rx, bufsize, 0); |
88e21f94 JS |
1182 | |
1183 | /* Verify pattern */ | |
1184 | g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); | |
1185 | ||
1186 | ahci_shutdown(src); | |
1187 | ahci_shutdown(dst); | |
1188 | g_free(rx); | |
1189 | g_free(tx); | |
6d9e7295 | 1190 | g_free(uri); |
88e21f94 JS |
1191 | } |
1192 | ||
07a1ee79 JS |
1193 | static void test_migrate_dma(void) |
1194 | { | |
1195 | ahci_migrate_simple(CMD_READ_DMA, CMD_WRITE_DMA); | |
1196 | } | |
1197 | ||
1198 | static void test_migrate_ncq(void) | |
1199 | { | |
1200 | ahci_migrate_simple(READ_FPDMA_QUEUED, WRITE_FPDMA_QUEUED); | |
1201 | } | |
1202 | ||
189d1b61 | 1203 | /** |
7f6cf5ee | 1204 | * Halted IO Error Test |
189d1b61 JS |
1205 | * |
1206 | * Simulate an error on first write, Try to write a pattern, | |
1207 | * Confirm the VM has stopped, resume the VM, verify command | |
1208 | * has completed, then read back the data and verify. | |
1209 | */ | |
7f6cf5ee | 1210 | static void ahci_halted_io_test(uint8_t cmd_read, uint8_t cmd_write) |
189d1b61 JS |
1211 | { |
1212 | AHCIQState *ahci; | |
1213 | uint8_t port; | |
1214 | size_t bufsize = 4096; | |
1215 | unsigned char *tx = g_malloc(bufsize); | |
1216 | unsigned char *rx = g_malloc0(bufsize); | |
189d1b61 JS |
1217 | uint64_t ptr; |
1218 | AHCICommand *cmd; | |
1219 | ||
1220 | prepare_blkdebug_script(debug_path, "write_aio"); | |
1221 | ||
1222 | ahci = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," | |
b236b610 | 1223 | "format=%s,cache=writeback," |
189d1b61 JS |
1224 | "rerror=stop,werror=stop " |
1225 | "-M q35 " | |
1226 | "-device ide-hd,drive=drive0 ", | |
1227 | debug_path, | |
b236b610 | 1228 | tmp_path, imgfmt); |
189d1b61 JS |
1229 | |
1230 | /* Initialize and prepare */ | |
1231 | port = ahci_port_select(ahci); | |
1232 | ahci_port_clear(ahci, port); | |
1233 | ||
189d1b61 | 1234 | /* create DMA source buffer and write pattern */ |
d7531638 | 1235 | generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); |
189d1b61 JS |
1236 | ptr = ahci_alloc(ahci, bufsize); |
1237 | g_assert(ptr); | |
1238 | memwrite(ptr, tx, bufsize); | |
1239 | ||
1240 | /* Attempt to write (and fail) */ | |
7f6cf5ee | 1241 | cmd = ahci_guest_io_halt(ahci, port, cmd_write, |
189d1b61 JS |
1242 | ptr, bufsize, 0); |
1243 | ||
1244 | /* Attempt to resume the command */ | |
1245 | ahci_guest_io_resume(ahci, cmd); | |
1246 | ahci_free(ahci, ptr); | |
1247 | ||
1248 | /* Read back and verify */ | |
7f6cf5ee | 1249 | ahci_io(ahci, port, cmd_read, rx, bufsize, 0); |
189d1b61 JS |
1250 | g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); |
1251 | ||
1252 | /* Cleanup and go home */ | |
1253 | ahci_shutdown(ahci); | |
1254 | g_free(rx); | |
1255 | g_free(tx); | |
1256 | } | |
1257 | ||
7f6cf5ee JS |
1258 | static void test_halted_dma(void) |
1259 | { | |
1260 | ahci_halted_io_test(CMD_READ_DMA, CMD_WRITE_DMA); | |
1261 | } | |
1262 | ||
1263 | static void test_halted_ncq(void) | |
1264 | { | |
1265 | ahci_halted_io_test(READ_FPDMA_QUEUED, WRITE_FPDMA_QUEUED); | |
1266 | } | |
1267 | ||
5d1cf091 | 1268 | /** |
8146d7dc | 1269 | * IO Error Migration Test |
5d1cf091 JS |
1270 | * |
1271 | * Simulate an error on first write, Try to write a pattern, | |
1272 | * Confirm the VM has stopped, migrate, resume the VM, | |
1273 | * verify command has completed, then read back the data and verify. | |
1274 | */ | |
8146d7dc | 1275 | static void ahci_migrate_halted_io(uint8_t cmd_read, uint8_t cmd_write) |
5d1cf091 JS |
1276 | { |
1277 | AHCIQState *src, *dst; | |
1278 | uint8_t port; | |
1279 | size_t bufsize = 4096; | |
1280 | unsigned char *tx = g_malloc(bufsize); | |
1281 | unsigned char *rx = g_malloc0(bufsize); | |
5d1cf091 JS |
1282 | uint64_t ptr; |
1283 | AHCICommand *cmd; | |
6d9e7295 | 1284 | char *uri = g_strdup_printf("unix:%s", mig_socket); |
5d1cf091 JS |
1285 | |
1286 | prepare_blkdebug_script(debug_path, "write_aio"); | |
1287 | ||
1288 | src = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," | |
b236b610 | 1289 | "format=%s,cache=writeback," |
5d1cf091 JS |
1290 | "rerror=stop,werror=stop " |
1291 | "-M q35 " | |
1292 | "-device ide-hd,drive=drive0 ", | |
1293 | debug_path, | |
b236b610 | 1294 | tmp_path, imgfmt); |
5d1cf091 JS |
1295 | |
1296 | dst = ahci_boot("-drive file=%s,if=none,id=drive0," | |
b236b610 | 1297 | "format=%s,cache=writeback," |
5d1cf091 JS |
1298 | "rerror=stop,werror=stop " |
1299 | "-M q35 " | |
1300 | "-device ide-hd,drive=drive0 " | |
1301 | "-incoming %s", | |
b236b610 | 1302 | tmp_path, imgfmt, uri); |
5d1cf091 JS |
1303 | |
1304 | set_context(src->parent); | |
1305 | ||
1306 | /* Initialize and prepare */ | |
1307 | port = ahci_port_select(src); | |
1308 | ahci_port_clear(src, port); | |
d7531638 | 1309 | generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); |
5d1cf091 JS |
1310 | |
1311 | /* create DMA source buffer and write pattern */ | |
1312 | ptr = ahci_alloc(src, bufsize); | |
1313 | g_assert(ptr); | |
1314 | memwrite(ptr, tx, bufsize); | |
1315 | ||
1316 | /* Write, trigger the VM to stop, migrate, then resume. */ | |
8146d7dc | 1317 | cmd = ahci_guest_io_halt(src, port, cmd_write, |
5d1cf091 JS |
1318 | ptr, bufsize, 0); |
1319 | ahci_migrate(src, dst, uri); | |
1320 | ahci_guest_io_resume(dst, cmd); | |
1321 | ahci_free(dst, ptr); | |
1322 | ||
1323 | /* Read back */ | |
8146d7dc | 1324 | ahci_io(dst, port, cmd_read, rx, bufsize, 0); |
5d1cf091 JS |
1325 | |
1326 | /* Verify TX and RX are identical */ | |
1327 | g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); | |
1328 | ||
1329 | /* Cleanup and go home. */ | |
1330 | ahci_shutdown(src); | |
1331 | ahci_shutdown(dst); | |
1332 | g_free(rx); | |
1333 | g_free(tx); | |
6d9e7295 | 1334 | g_free(uri); |
5d1cf091 JS |
1335 | } |
1336 | ||
8146d7dc JS |
1337 | static void test_migrate_halted_dma(void) |
1338 | { | |
1339 | ahci_migrate_halted_io(CMD_READ_DMA, CMD_WRITE_DMA); | |
1340 | } | |
1341 | ||
1342 | static void test_migrate_halted_ncq(void) | |
1343 | { | |
1344 | ahci_migrate_halted_io(READ_FPDMA_QUEUED, WRITE_FPDMA_QUEUED); | |
1345 | } | |
1346 | ||
a606ce50 JS |
1347 | /** |
1348 | * Migration test: Try to flush, migrate, then resume. | |
1349 | */ | |
1350 | static void test_flush_migrate(void) | |
1351 | { | |
1352 | AHCIQState *src, *dst; | |
1353 | AHCICommand *cmd; | |
1354 | uint8_t px; | |
1355 | const char *s; | |
6d9e7295 | 1356 | char *uri = g_strdup_printf("unix:%s", mig_socket); |
a606ce50 JS |
1357 | |
1358 | prepare_blkdebug_script(debug_path, "flush_to_disk"); | |
1359 | ||
1360 | src = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," | |
b236b610 JS |
1361 | "cache=writeback,rerror=stop,werror=stop," |
1362 | "format=%s " | |
a606ce50 JS |
1363 | "-M q35 " |
1364 | "-device ide-hd,drive=drive0 ", | |
b236b610 | 1365 | debug_path, tmp_path, imgfmt); |
a606ce50 | 1366 | dst = ahci_boot("-drive file=%s,if=none,id=drive0," |
b236b610 JS |
1367 | "cache=writeback,rerror=stop,werror=stop," |
1368 | "format=%s " | |
a606ce50 JS |
1369 | "-M q35 " |
1370 | "-device ide-hd,drive=drive0 " | |
b236b610 | 1371 | "-incoming %s", tmp_path, imgfmt, uri); |
a606ce50 JS |
1372 | |
1373 | set_context(src->parent); | |
1374 | ||
a606ce50 JS |
1375 | px = ahci_port_select(src); |
1376 | ahci_port_clear(src, px); | |
2dd7e10d EY |
1377 | |
1378 | /* Dirty device so that flush reaches disk */ | |
1379 | make_dirty(src, px); | |
1380 | ||
1381 | /* Issue Flush Command */ | |
a606ce50 JS |
1382 | cmd = ahci_command_create(CMD_FLUSH_CACHE); |
1383 | ahci_command_commit(src, cmd, px); | |
1384 | ahci_command_issue_async(src, cmd); | |
1385 | qmp_eventwait("STOP"); | |
1386 | ||
1387 | /* Migrate over */ | |
1388 | ahci_migrate(src, dst, uri); | |
1389 | ||
1390 | /* Complete the command */ | |
1391 | s = "{'execute':'cont' }"; | |
1392 | qmp_async(s); | |
1393 | qmp_eventwait("RESUME"); | |
1394 | ahci_command_wait(dst, cmd); | |
1395 | ahci_command_verify(dst, cmd); | |
1396 | ||
1397 | ahci_command_free(cmd); | |
1398 | ahci_shutdown(src); | |
1399 | ahci_shutdown(dst); | |
6d9e7295 | 1400 | g_free(uri); |
a606ce50 JS |
1401 | } |
1402 | ||
0d3e9d1f JS |
1403 | static void test_max(void) |
1404 | { | |
1405 | AHCIQState *ahci; | |
1406 | ||
1407 | ahci = ahci_boot_and_enable(NULL); | |
1408 | ahci_test_max(ahci); | |
1409 | ahci_shutdown(ahci); | |
1410 | } | |
1411 | ||
d31a3ebc JS |
1412 | static void test_reset(void) |
1413 | { | |
1414 | AHCIQState *ahci; | |
1415 | int i; | |
1416 | ||
1417 | ahci = ahci_boot(NULL); | |
1418 | ahci_test_pci_spec(ahci); | |
1419 | ahci_pci_enable(ahci); | |
1420 | ||
1421 | for (i = 0; i < 2; i++) { | |
1422 | ahci_test_hba_spec(ahci); | |
1423 | ahci_hba_enable(ahci); | |
1424 | ahci_test_identify(ahci); | |
1425 | ahci_test_io_rw_simple(ahci, 4096, 0, | |
1426 | CMD_READ_DMA_EXT, | |
1427 | CMD_WRITE_DMA_EXT); | |
1428 | ahci_set(ahci, AHCI_GHC, AHCI_GHC_HR); | |
1429 | ahci_clean_mem(ahci); | |
1430 | } | |
1431 | ||
1432 | ahci_shutdown(ahci); | |
1433 | } | |
1434 | ||
26ad0045 JS |
1435 | static void test_ncq_simple(void) |
1436 | { | |
1437 | AHCIQState *ahci; | |
1438 | ||
1439 | ahci = ahci_boot_and_enable(NULL); | |
1440 | ahci_test_io_rw_simple(ahci, 4096, 0, | |
1441 | READ_FPDMA_QUEUED, | |
1442 | WRITE_FPDMA_QUEUED); | |
1443 | ahci_shutdown(ahci); | |
1444 | } | |
1445 | ||
e8109694 JS |
1446 | static int prepare_iso(size_t size, unsigned char **buf, char **name) |
1447 | { | |
1448 | char cdrom_path[] = "/tmp/qtest.iso.XXXXXX"; | |
1449 | unsigned char *patt; | |
1450 | ssize_t ret; | |
1451 | int fd = mkstemp(cdrom_path); | |
1452 | ||
1453 | g_assert(buf); | |
1454 | g_assert(name); | |
1455 | patt = g_malloc(size); | |
1456 | ||
1457 | /* Generate a pattern and build a CDROM image to read from */ | |
1458 | generate_pattern(patt, size, ATAPI_SECTOR_SIZE); | |
1459 | ret = write(fd, patt, size); | |
1460 | g_assert(ret == size); | |
1461 | ||
1462 | *name = g_strdup(cdrom_path); | |
1463 | *buf = patt; | |
1464 | return fd; | |
1465 | } | |
1466 | ||
1467 | static void remove_iso(int fd, char *name) | |
1468 | { | |
1469 | unlink(name); | |
1470 | g_free(name); | |
1471 | close(fd); | |
1472 | } | |
1473 | ||
1474 | static int ahci_cb_cmp_buff(AHCIQState *ahci, AHCICommand *cmd, | |
1475 | const AHCIOpts *opts) | |
1476 | { | |
1477 | unsigned char *tx = opts->opaque; | |
ebde93bf | 1478 | unsigned char *rx; |
e8109694 | 1479 | |
ebde93bf JS |
1480 | if (!opts->size) { |
1481 | return 0; | |
1482 | } | |
1483 | ||
1484 | rx = g_malloc0(opts->size); | |
e8109694 JS |
1485 | bufread(opts->buffer, rx, opts->size); |
1486 | g_assert_cmphex(memcmp(tx, rx, opts->size), ==, 0); | |
1487 | g_free(rx); | |
1488 | ||
1489 | return 0; | |
1490 | } | |
1491 | ||
ebde93bf JS |
1492 | static void ahci_test_cdrom(int nsectors, bool dma, uint8_t cmd, |
1493 | bool override_bcl, uint16_t bcl) | |
e8109694 JS |
1494 | { |
1495 | AHCIQState *ahci; | |
1496 | unsigned char *tx; | |
1497 | char *iso; | |
1498 | int fd; | |
1499 | AHCIOpts opts = { | |
1500 | .size = (ATAPI_SECTOR_SIZE * nsectors), | |
1501 | .atapi = true, | |
1502 | .atapi_dma = dma, | |
1503 | .post_cb = ahci_cb_cmp_buff, | |
ebde93bf JS |
1504 | .set_bcl = override_bcl, |
1505 | .bcl = bcl, | |
e8109694 | 1506 | }; |
53c05e6c | 1507 | uint64_t iso_size = ATAPI_SECTOR_SIZE * (nsectors + 1); |
e8109694 JS |
1508 | |
1509 | /* Prepare ISO and fill 'tx' buffer */ | |
53c05e6c | 1510 | fd = prepare_iso(iso_size, &tx, &iso); |
e8109694 JS |
1511 | opts.opaque = tx; |
1512 | ||
1513 | /* Standard startup wonkery, but use ide-cd and our special iso file */ | |
1514 | ahci = ahci_boot_and_enable("-drive if=none,id=drive0,file=%s,format=raw " | |
1515 | "-M q35 " | |
1516 | "-device ide-cd,drive=drive0 ", iso); | |
1517 | ||
1518 | /* Build & Send AHCI command */ | |
ebde93bf | 1519 | ahci_exec(ahci, ahci_port_select(ahci), cmd, &opts); |
e8109694 JS |
1520 | |
1521 | /* Cleanup */ | |
1522 | g_free(tx); | |
1523 | ahci_shutdown(ahci); | |
1524 | remove_iso(fd, iso); | |
1525 | } | |
1526 | ||
ebde93bf JS |
1527 | static void ahci_test_cdrom_read10(int nsectors, bool dma) |
1528 | { | |
1529 | ahci_test_cdrom(nsectors, dma, CMD_ATAPI_READ_10, false, 0); | |
1530 | } | |
1531 | ||
e8109694 JS |
1532 | static void test_cdrom_dma(void) |
1533 | { | |
ebde93bf | 1534 | ahci_test_cdrom_read10(1, true); |
e8109694 JS |
1535 | } |
1536 | ||
1537 | static void test_cdrom_dma_multi(void) | |
1538 | { | |
ebde93bf | 1539 | ahci_test_cdrom_read10(3, true); |
e8109694 JS |
1540 | } |
1541 | ||
1542 | static void test_cdrom_pio(void) | |
1543 | { | |
ebde93bf | 1544 | ahci_test_cdrom_read10(1, false); |
e8109694 JS |
1545 | } |
1546 | ||
1547 | static void test_cdrom_pio_multi(void) | |
1548 | { | |
ebde93bf JS |
1549 | ahci_test_cdrom_read10(3, false); |
1550 | } | |
1551 | ||
1552 | /* Regression test: Test that a READ_CD command with a BCL of 0 but a size of 0 | |
1553 | * completes as a NOP instead of erroring out. */ | |
1554 | static void test_atapi_bcl(void) | |
1555 | { | |
1556 | ahci_test_cdrom(0, false, CMD_ATAPI_READ_CD, true, 0); | |
e8109694 JS |
1557 | } |
1558 | ||
22381d41 JS |
1559 | |
1560 | static void atapi_wait_tray(bool open) | |
1561 | { | |
1562 | QDict *rsp = qmp_eventwait_ref("DEVICE_TRAY_MOVED"); | |
1563 | QDict *data = qdict_get_qdict(rsp, "data"); | |
1564 | if (open) { | |
1565 | g_assert(qdict_get_bool(data, "tray-open")); | |
1566 | } else { | |
1567 | g_assert(!qdict_get_bool(data, "tray-open")); | |
1568 | } | |
1569 | QDECREF(rsp); | |
1570 | } | |
1571 | ||
1572 | static void test_atapi_tray(void) | |
1573 | { | |
1574 | AHCIQState *ahci; | |
1575 | unsigned char *tx; | |
1576 | char *iso; | |
1577 | int fd; | |
1578 | uint8_t port, sense, asc; | |
1579 | uint64_t iso_size = ATAPI_SECTOR_SIZE; | |
1580 | QDict *rsp; | |
1581 | ||
1582 | fd = prepare_iso(iso_size, &tx, &iso); | |
f6c3dc13 | 1583 | ahci = ahci_boot_and_enable("-blockdev node-name=drive0,driver=file,filename=%s " |
22381d41 | 1584 | "-M q35 " |
f6c3dc13 | 1585 | "-device ide-cd,id=cd0,drive=drive0 ", iso); |
22381d41 JS |
1586 | port = ahci_port_select(ahci); |
1587 | ||
1588 | ahci_atapi_eject(ahci, port); | |
1589 | atapi_wait_tray(true); | |
1590 | ||
1591 | ahci_atapi_load(ahci, port); | |
1592 | atapi_wait_tray(false); | |
1593 | ||
1594 | /* Remove media */ | |
1595 | qmp_async("{'execute': 'blockdev-open-tray', " | |
f6c3dc13 | 1596 | "'arguments': {'id': 'cd0'}}"); |
22381d41 JS |
1597 | atapi_wait_tray(true); |
1598 | rsp = qmp_receive(); | |
1599 | QDECREF(rsp); | |
1600 | ||
34ce1111 | 1601 | qmp_discard_response("{'execute': 'blockdev-remove-medium', " |
f6c3dc13 | 1602 | "'arguments': {'id': 'cd0'}}"); |
22381d41 JS |
1603 | |
1604 | /* Test the tray without a medium */ | |
1605 | ahci_atapi_load(ahci, port); | |
1606 | atapi_wait_tray(false); | |
1607 | ||
1608 | ahci_atapi_eject(ahci, port); | |
1609 | atapi_wait_tray(true); | |
1610 | ||
1611 | /* Re-insert media */ | |
1612 | qmp_discard_response("{'execute': 'blockdev-add', " | |
1613 | "'arguments': {'node-name': 'node0', " | |
1614 | "'driver': 'raw', " | |
1615 | "'file': { 'driver': 'file', " | |
1616 | "'filename': %s }}}", iso); | |
34ce1111 | 1617 | qmp_discard_response("{'execute': 'blockdev-insert-medium'," |
f6c3dc13 | 1618 | "'arguments': { 'id': 'cd0', " |
22381d41 JS |
1619 | "'node-name': 'node0' }}"); |
1620 | ||
1621 | /* Again, the event shows up first */ | |
1622 | qmp_async("{'execute': 'blockdev-close-tray', " | |
f6c3dc13 | 1623 | "'arguments': {'id': 'cd0'}}"); |
22381d41 JS |
1624 | atapi_wait_tray(false); |
1625 | rsp = qmp_receive(); | |
1626 | QDECREF(rsp); | |
1627 | ||
1628 | /* Now, to convince ATAPI we understand the media has changed... */ | |
1629 | ahci_atapi_test_ready(ahci, port, false, SENSE_NOT_READY); | |
1630 | ahci_atapi_get_sense(ahci, port, &sense, &asc); | |
1631 | g_assert_cmpuint(sense, ==, SENSE_NOT_READY); | |
1632 | g_assert_cmpuint(asc, ==, ASC_MEDIUM_NOT_PRESENT); | |
1633 | ||
1634 | ahci_atapi_test_ready(ahci, port, false, SENSE_UNIT_ATTENTION); | |
1635 | ahci_atapi_get_sense(ahci, port, &sense, &asc); | |
1636 | g_assert_cmpuint(sense, ==, SENSE_UNIT_ATTENTION); | |
1637 | g_assert_cmpuint(asc, ==, ASC_MEDIUM_MAY_HAVE_CHANGED); | |
1638 | ||
1639 | ahci_atapi_test_ready(ahci, port, true, SENSE_NO_SENSE); | |
1640 | ahci_atapi_get_sense(ahci, port, &sense, &asc); | |
1641 | g_assert_cmpuint(sense, ==, SENSE_NO_SENSE); | |
1642 | ||
1643 | /* Final tray test. */ | |
1644 | ahci_atapi_eject(ahci, port); | |
1645 | atapi_wait_tray(true); | |
1646 | ||
1647 | ahci_atapi_load(ahci, port); | |
1648 | atapi_wait_tray(false); | |
1649 | ||
1650 | /* Cleanup */ | |
1651 | g_free(tx); | |
1652 | ahci_shutdown(ahci); | |
1653 | remove_iso(fd, iso); | |
1654 | } | |
1655 | ||
bda39dc2 JS |
1656 | /******************************************************************************/ |
1657 | /* AHCI I/O Test Matrix Definitions */ | |
1658 | ||
1659 | enum BuffLen { | |
1660 | LEN_BEGIN = 0, | |
1661 | LEN_SIMPLE = LEN_BEGIN, | |
1662 | LEN_DOUBLE, | |
1663 | LEN_LONG, | |
1664 | LEN_SHORT, | |
1665 | NUM_LENGTHS | |
1666 | }; | |
1667 | ||
1668 | static const char *buff_len_str[NUM_LENGTHS] = { "simple", "double", | |
1669 | "long", "short" }; | |
1670 | ||
1671 | enum AddrMode { | |
1672 | ADDR_MODE_BEGIN = 0, | |
1673 | ADDR_MODE_LBA28 = ADDR_MODE_BEGIN, | |
1674 | ADDR_MODE_LBA48, | |
1675 | NUM_ADDR_MODES | |
1676 | }; | |
1677 | ||
1678 | static const char *addr_mode_str[NUM_ADDR_MODES] = { "lba28", "lba48" }; | |
1679 | ||
1680 | enum IOMode { | |
1681 | MODE_BEGIN = 0, | |
1682 | MODE_PIO = MODE_BEGIN, | |
1683 | MODE_DMA, | |
1684 | NUM_MODES | |
1685 | }; | |
1686 | ||
1687 | static const char *io_mode_str[NUM_MODES] = { "pio", "dma" }; | |
1688 | ||
1689 | enum IOOps { | |
1690 | IO_BEGIN = 0, | |
1691 | IO_READ = IO_BEGIN, | |
1692 | IO_WRITE, | |
1693 | NUM_IO_OPS | |
1694 | }; | |
1695 | ||
727be1a7 JS |
1696 | enum OffsetType { |
1697 | OFFSET_BEGIN = 0, | |
1698 | OFFSET_ZERO = OFFSET_BEGIN, | |
1699 | OFFSET_LOW, | |
1700 | OFFSET_HIGH, | |
1701 | NUM_OFFSETS | |
1702 | }; | |
1703 | ||
1704 | static const char *offset_str[NUM_OFFSETS] = { "zero", "low", "high" }; | |
1705 | ||
bda39dc2 JS |
1706 | typedef struct AHCIIOTestOptions { |
1707 | enum BuffLen length; | |
1708 | enum AddrMode address_type; | |
1709 | enum IOMode io_type; | |
727be1a7 | 1710 | enum OffsetType offset; |
bda39dc2 JS |
1711 | } AHCIIOTestOptions; |
1712 | ||
727be1a7 JS |
1713 | static uint64_t offset_sector(enum OffsetType ofst, |
1714 | enum AddrMode addr_type, | |
1715 | uint64_t buffsize) | |
1716 | { | |
1717 | uint64_t ceil; | |
1718 | uint64_t nsectors; | |
1719 | ||
1720 | switch (ofst) { | |
1721 | case OFFSET_ZERO: | |
1722 | return 0; | |
1723 | case OFFSET_LOW: | |
1724 | return 1; | |
1725 | case OFFSET_HIGH: | |
1726 | ceil = (addr_type == ADDR_MODE_LBA28) ? 0xfffffff : 0xffffffffffff; | |
917158dc | 1727 | ceil = MIN(ceil, mb_to_sectors(test_image_size_mb) - 1); |
727be1a7 JS |
1728 | nsectors = buffsize / AHCI_SECTOR_SIZE; |
1729 | return ceil - nsectors + 1; | |
1730 | default: | |
1731 | g_assert_not_reached(); | |
1732 | } | |
1733 | } | |
1734 | ||
81705ee4 | 1735 | /** |
bda39dc2 | 1736 | * Table of possible I/O ATA commands given a set of enumerations. |
81705ee4 | 1737 | */ |
bda39dc2 JS |
1738 | static const uint8_t io_cmds[NUM_MODES][NUM_ADDR_MODES][NUM_IO_OPS] = { |
1739 | [MODE_PIO] = { | |
1740 | [ADDR_MODE_LBA28] = { | |
1741 | [IO_READ] = CMD_READ_PIO, | |
1742 | [IO_WRITE] = CMD_WRITE_PIO }, | |
1743 | [ADDR_MODE_LBA48] = { | |
1744 | [IO_READ] = CMD_READ_PIO_EXT, | |
1745 | [IO_WRITE] = CMD_WRITE_PIO_EXT } | |
1746 | }, | |
1747 | [MODE_DMA] = { | |
1748 | [ADDR_MODE_LBA28] = { | |
1749 | [IO_READ] = CMD_READ_DMA, | |
1750 | [IO_WRITE] = CMD_WRITE_DMA }, | |
1751 | [ADDR_MODE_LBA48] = { | |
1752 | [IO_READ] = CMD_READ_DMA_EXT, | |
1753 | [IO_WRITE] = CMD_WRITE_DMA_EXT } | |
1754 | } | |
1755 | }; | |
1756 | ||
1757 | /** | |
1758 | * Test a Read/Write pattern using various commands, addressing modes, | |
1759 | * transfer modes, and buffer sizes. | |
1760 | */ | |
1761 | static void test_io_rw_interface(enum AddrMode lba48, enum IOMode dma, | |
727be1a7 | 1762 | unsigned bufsize, uint64_t sector) |
81705ee4 JS |
1763 | { |
1764 | AHCIQState *ahci; | |
1765 | ||
debaaa11 | 1766 | ahci = ahci_boot_and_enable(NULL); |
727be1a7 | 1767 | ahci_test_io_rw_simple(ahci, bufsize, sector, |
bda39dc2 JS |
1768 | io_cmds[dma][lba48][IO_READ], |
1769 | io_cmds[dma][lba48][IO_WRITE]); | |
81705ee4 JS |
1770 | ahci_shutdown(ahci); |
1771 | } | |
1772 | ||
bda39dc2 JS |
1773 | /** |
1774 | * Demultiplex the test data and invoke the actual test routine. | |
1775 | */ | |
1776 | static void test_io_interface(gconstpointer opaque) | |
d6c403ed | 1777 | { |
bda39dc2 JS |
1778 | AHCIIOTestOptions *opts = (AHCIIOTestOptions *)opaque; |
1779 | unsigned bufsize; | |
727be1a7 | 1780 | uint64_t sector; |
d6c403ed | 1781 | |
bda39dc2 JS |
1782 | switch (opts->length) { |
1783 | case LEN_SIMPLE: | |
1784 | bufsize = 4096; | |
1785 | break; | |
1786 | case LEN_DOUBLE: | |
1787 | bufsize = 8192; | |
1788 | break; | |
1789 | case LEN_LONG: | |
1790 | bufsize = 4096 * 64; | |
1791 | break; | |
1792 | case LEN_SHORT: | |
1793 | bufsize = 512; | |
1794 | break; | |
1795 | default: | |
1796 | g_assert_not_reached(); | |
1797 | } | |
d6c403ed | 1798 | |
727be1a7 JS |
1799 | sector = offset_sector(opts->offset, opts->address_type, bufsize); |
1800 | test_io_rw_interface(opts->address_type, opts->io_type, bufsize, sector); | |
bda39dc2 JS |
1801 | g_free(opts); |
1802 | return; | |
d6c403ed JS |
1803 | } |
1804 | ||
bda39dc2 | 1805 | static void create_ahci_io_test(enum IOMode type, enum AddrMode addr, |
727be1a7 | 1806 | enum BuffLen len, enum OffsetType offset) |
d6c403ed | 1807 | { |
bda39dc2 | 1808 | char *name; |
917158dc | 1809 | AHCIIOTestOptions *opts; |
bda39dc2 | 1810 | |
790bbb97 | 1811 | opts = g_new(AHCIIOTestOptions, 1); |
bda39dc2 JS |
1812 | opts->length = len; |
1813 | opts->address_type = addr; | |
1814 | opts->io_type = type; | |
727be1a7 | 1815 | opts->offset = offset; |
bda39dc2 | 1816 | |
53f77e45 | 1817 | name = g_strdup_printf("ahci/io/%s/%s/%s/%s", |
bda39dc2 JS |
1818 | io_mode_str[type], |
1819 | addr_mode_str[addr], | |
727be1a7 JS |
1820 | buff_len_str[len], |
1821 | offset_str[offset]); | |
bda39dc2 | 1822 | |
917158dc JS |
1823 | if ((addr == ADDR_MODE_LBA48) && (offset == OFFSET_HIGH) && |
1824 | (mb_to_sectors(test_image_size_mb) <= 0xFFFFFFF)) { | |
1825 | g_test_message("%s: skipped; test image too small", name); | |
0fd76bc5 | 1826 | g_free(opts); |
917158dc JS |
1827 | g_free(name); |
1828 | return; | |
1829 | } | |
1830 | ||
53f77e45 | 1831 | qtest_add_data_func(name, opts, test_io_interface); |
bda39dc2 | 1832 | g_free(name); |
d6c403ed JS |
1833 | } |
1834 | ||
1cd1031d JS |
1835 | /******************************************************************************/ |
1836 | ||
1837 | int main(int argc, char **argv) | |
1838 | { | |
1839 | const char *arch; | |
1cd1031d | 1840 | int ret; |
cf5aa89e | 1841 | int fd; |
8840a843 | 1842 | int c; |
727be1a7 | 1843 | int i, j, k, m; |
8840a843 JS |
1844 | |
1845 | static struct option long_options[] = { | |
1846 | {"pedantic", no_argument, 0, 'p' }, | |
1847 | {0, 0, 0, 0}, | |
1848 | }; | |
1cd1031d JS |
1849 | |
1850 | /* Should be first to utilize g_test functionality, So we can see errors. */ | |
1851 | g_test_init(&argc, &argv, NULL); | |
1852 | ||
8840a843 JS |
1853 | while (1) { |
1854 | c = getopt_long(argc, argv, "", long_options, NULL); | |
1855 | if (c == -1) { | |
1856 | break; | |
1857 | } | |
1858 | switch (c) { | |
1859 | case -1: | |
1860 | break; | |
1861 | case 'p': | |
1862 | ahci_pedantic = 1; | |
1863 | break; | |
1864 | default: | |
1865 | fprintf(stderr, "Unrecognized ahci_test option.\n"); | |
1866 | g_assert_not_reached(); | |
1867 | } | |
1868 | } | |
1869 | ||
1cd1031d JS |
1870 | /* Check architecture */ |
1871 | arch = qtest_get_arch(); | |
1872 | if (strcmp(arch, "i386") && strcmp(arch, "x86_64")) { | |
1873 | g_test_message("Skipping test for non-x86"); | |
1874 | return 0; | |
1875 | } | |
1876 | ||
b236b610 JS |
1877 | /* Create a temporary image */ |
1878 | fd = mkstemp(tmp_path); | |
1879 | g_assert(fd >= 0); | |
917158dc JS |
1880 | if (have_qemu_img()) { |
1881 | imgfmt = "qcow2"; | |
1882 | test_image_size_mb = TEST_IMAGE_SIZE_MB_LARGE; | |
1883 | mkqcow2(tmp_path, TEST_IMAGE_SIZE_MB_LARGE); | |
1884 | } else { | |
1885 | g_test_message("QTEST_QEMU_IMG not set or qemu-img missing; " | |
1886 | "skipping LBA48 high-sector tests"); | |
1887 | imgfmt = "raw"; | |
1888 | test_image_size_mb = TEST_IMAGE_SIZE_MB_SMALL; | |
1889 | ret = ftruncate(fd, test_image_size_mb * 1024 * 1024); | |
1890 | g_assert(ret == 0); | |
1891 | } | |
b236b610 | 1892 | close(fd); |
1cd1031d | 1893 | |
cf5aa89e JS |
1894 | /* Create temporary blkdebug instructions */ |
1895 | fd = mkstemp(debug_path); | |
1896 | g_assert(fd >= 0); | |
1897 | close(fd); | |
1898 | ||
6d9e7295 JS |
1899 | /* Reserve a hollow file to use as a socket for migration tests */ |
1900 | fd = mkstemp(mig_socket); | |
1901 | g_assert(fd >= 0); | |
1902 | close(fd); | |
1903 | ||
1cd1031d JS |
1904 | /* Run the tests */ |
1905 | qtest_add_func("/ahci/sanity", test_sanity); | |
8840a843 | 1906 | qtest_add_func("/ahci/pci_spec", test_pci_spec); |
96d6d3ba | 1907 | qtest_add_func("/ahci/pci_enable", test_pci_enable); |
c2f3029f | 1908 | qtest_add_func("/ahci/hba_spec", test_hba_spec); |
dbc180e5 | 1909 | qtest_add_func("/ahci/hba_enable", test_hba_enable); |
0fa781e3 | 1910 | qtest_add_func("/ahci/identify", test_identify); |
bda39dc2 JS |
1911 | |
1912 | for (i = MODE_BEGIN; i < NUM_MODES; i++) { | |
1913 | for (j = ADDR_MODE_BEGIN; j < NUM_ADDR_MODES; j++) { | |
1914 | for (k = LEN_BEGIN; k < NUM_LENGTHS; k++) { | |
727be1a7 JS |
1915 | for (m = OFFSET_BEGIN; m < NUM_OFFSETS; m++) { |
1916 | create_ahci_io_test(i, j, k, m); | |
1917 | } | |
bda39dc2 JS |
1918 | } |
1919 | } | |
1920 | } | |
1cd1031d | 1921 | |
e0c59cc7 JS |
1922 | qtest_add_func("/ahci/io/dma/lba28/fragmented", test_dma_fragmented); |
1923 | ||
4e217074 | 1924 | qtest_add_func("/ahci/flush/simple", test_flush); |
cf5aa89e | 1925 | qtest_add_func("/ahci/flush/retry", test_flush_retry); |
a606ce50 | 1926 | qtest_add_func("/ahci/flush/migrate", test_flush_migrate); |
4e217074 | 1927 | |
278128ab | 1928 | qtest_add_func("/ahci/migrate/sanity", test_migrate_sanity); |
5d1cf091 | 1929 | qtest_add_func("/ahci/migrate/dma/simple", test_migrate_dma); |
189d1b61 | 1930 | qtest_add_func("/ahci/io/dma/lba28/retry", test_halted_dma); |
5d1cf091 | 1931 | qtest_add_func("/ahci/migrate/dma/halted", test_migrate_halted_dma); |
278128ab | 1932 | |
0d3e9d1f | 1933 | qtest_add_func("/ahci/max", test_max); |
d31a3ebc | 1934 | qtest_add_func("/ahci/reset", test_reset); |
0d3e9d1f | 1935 | |
26ad0045 | 1936 | qtest_add_func("/ahci/io/ncq/simple", test_ncq_simple); |
07a1ee79 | 1937 | qtest_add_func("/ahci/migrate/ncq/simple", test_migrate_ncq); |
7f6cf5ee | 1938 | qtest_add_func("/ahci/io/ncq/retry", test_halted_ncq); |
8146d7dc | 1939 | qtest_add_func("/ahci/migrate/ncq/halted", test_migrate_halted_ncq); |
26ad0045 | 1940 | |
e8109694 JS |
1941 | qtest_add_func("/ahci/cdrom/dma/single", test_cdrom_dma); |
1942 | qtest_add_func("/ahci/cdrom/dma/multi", test_cdrom_dma_multi); | |
1943 | qtest_add_func("/ahci/cdrom/pio/single", test_cdrom_pio); | |
1944 | qtest_add_func("/ahci/cdrom/pio/multi", test_cdrom_pio_multi); | |
1945 | ||
ebde93bf | 1946 | qtest_add_func("/ahci/cdrom/pio/bcl", test_atapi_bcl); |
22381d41 | 1947 | qtest_add_func("/ahci/cdrom/eject", test_atapi_tray); |
ebde93bf | 1948 | |
1cd1031d JS |
1949 | ret = g_test_run(); |
1950 | ||
1951 | /* Cleanup */ | |
1952 | unlink(tmp_path); | |
cf5aa89e | 1953 | unlink(debug_path); |
6d9e7295 | 1954 | unlink(mig_socket); |
1cd1031d JS |
1955 | |
1956 | return ret; | |
1957 | } |