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 25 #include "qemu/osdep.h" 26 #include <getopt.h> 27 28 #include "libqtest.h" 29 #include "libqos/libqos-pc.h" 30 #include "libqos/ahci.h" 31 #include "libqos/pci-pc.h" 32 33 #include "qapi/qmp/qdict.h" 34 #include "qemu/host-utils.h" 35 36 #include "hw/pci/pci_ids.h" 37 #include "hw/pci/pci_regs.h" 38 39 /* Test images sizes in MB */ 40 #define TEST_IMAGE_SIZE_MB_LARGE (200 * 1024) 41 #define TEST_IMAGE_SIZE_MB_SMALL 64 42 43 /*** Globals ***/ 44 static char *tmp_path; 45 static char *debug_path; 46 static char *mig_socket; 47 static bool ahci_pedantic; 48 static const char *imgfmt; 49 static unsigned test_image_size_mb; 50 51 /*** Function Declarations ***/ 52 static void ahci_test_port_spec(AHCIQState *ahci, uint8_t port); 53 static void ahci_test_pci_spec(AHCIQState *ahci); 54 static void ahci_test_pci_caps(AHCIQState *ahci, uint16_t header, 55 uint8_t offset); 56 static void ahci_test_satacap(AHCIQState *ahci, uint8_t offset); 57 static void ahci_test_msicap(AHCIQState *ahci, uint8_t offset); 58 static void ahci_test_pmcap(AHCIQState *ahci, uint8_t offset); 59 60 /*** Utilities ***/ 61 mb_to_sectors(uint64_t image_size_mb)62 static uint64_t mb_to_sectors(uint64_t image_size_mb) 63 { 64 return (image_size_mb * 1024 * 1024) / AHCI_SECTOR_SIZE; 65 } 66 string_bswap16(uint16_t * s,size_t bytes)67 static void string_bswap16(uint16_t *s, size_t bytes) 68 { 69 g_assert_cmphex((bytes & 1), ==, 0); 70 bytes /= 2; 71 72 while (bytes--) { 73 *s = bswap16(*s); 74 s++; 75 } 76 } 77 78 /** 79 * Verify that the transfer did not corrupt our state at all. 80 */ verify_state(AHCIQState * ahci,uint64_t hba_old)81 static void verify_state(AHCIQState *ahci, uint64_t hba_old) 82 { 83 int i, j; 84 uint32_t ahci_fingerprint; 85 uint64_t hba_base; 86 AHCICommandHeader cmd; 87 88 ahci_fingerprint = qpci_config_readl(ahci->dev, PCI_VENDOR_ID); 89 g_assert_cmphex(ahci_fingerprint, ==, ahci->fingerprint); 90 91 /* If we haven't initialized, this is as much as can be validated. */ 92 if (!ahci->enabled) { 93 return; 94 } 95 96 hba_base = (uint64_t)qpci_config_readl(ahci->dev, PCI_BASE_ADDRESS_5); 97 g_assert_cmphex(hba_base, ==, hba_old); 98 99 g_assert_cmphex(ahci_rreg(ahci, AHCI_CAP), ==, ahci->cap); 100 g_assert_cmphex(ahci_rreg(ahci, AHCI_CAP2), ==, ahci->cap2); 101 102 for (i = 0; i < 32; i++) { 103 g_assert_cmphex(ahci_px_rreg(ahci, i, AHCI_PX_FB), ==, 104 ahci->port[i].fb); 105 g_assert_cmphex(ahci_px_rreg(ahci, i, AHCI_PX_CLB), ==, 106 ahci->port[i].clb); 107 for (j = 0; j < 32; j++) { 108 ahci_get_command_header(ahci, i, j, &cmd); 109 g_assert_cmphex(cmd.prdtl, ==, ahci->port[i].prdtl[j]); 110 g_assert_cmphex(cmd.ctba, ==, ahci->port[i].ctba[j]); 111 } 112 } 113 } 114 ahci_migrate(AHCIQState * from,AHCIQState * to,const char * uri)115 static void ahci_migrate(AHCIQState *from, AHCIQState *to, const char *uri) 116 { 117 QOSState *tmp = to->parent; 118 QPCIDevice *dev = to->dev; 119 char *uri_local = NULL; 120 uint64_t hba_old; 121 122 if (uri == NULL) { 123 uri_local = g_strdup_printf("%s%s", "unix:", mig_socket); 124 uri = uri_local; 125 } 126 127 hba_old = (uint64_t)qpci_config_readl(from->dev, PCI_BASE_ADDRESS_5); 128 129 /* context will be 'to' after completion. */ 130 migrate(from->parent, to->parent, uri); 131 132 /* We'd like for the AHCIState objects to still point 133 * to information specific to its specific parent 134 * instance, but otherwise just inherit the new data. */ 135 memcpy(to, from, sizeof(AHCIQState)); 136 to->parent = tmp; 137 to->dev = dev; 138 139 tmp = from->parent; 140 dev = from->dev; 141 memset(from, 0x00, sizeof(AHCIQState)); 142 from->parent = tmp; 143 from->dev = dev; 144 145 verify_state(to, hba_old); 146 g_free(uri_local); 147 } 148 149 /*** Test Setup & Teardown ***/ 150 151 /** 152 * Start a Q35 machine and bookmark a handle to the AHCI device. 153 */ 154 G_GNUC_PRINTF(1, 0) ahci_vboot(const char * cli,va_list ap)155 static AHCIQState *ahci_vboot(const char *cli, va_list ap) 156 { 157 AHCIQState *s; 158 159 s = g_new0(AHCIQState, 1); 160 s->parent = qtest_pc_vboot(cli, ap); 161 alloc_set_flags(&s->parent->alloc, ALLOC_LEAK_ASSERT); 162 163 /* Verify that we have an AHCI device present. */ 164 s->dev = get_ahci_device(s->parent->qts, &s->fingerprint); 165 166 return s; 167 } 168 169 /** 170 * Start a Q35 machine and bookmark a handle to the AHCI device. 171 */ 172 G_GNUC_PRINTF(1, 2) ahci_boot(const char * cli,...)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,format=%s" 184 " -M q35 " 185 "-device ide-hd,drive=drive0 " 186 "-global ide-hd.serial=%s " 187 "-global ide-hd.ver=%s"; 188 s = ahci_boot(cli, tmp_path, imgfmt, "testdisk", "version"); 189 } 190 191 return s; 192 } 193 194 /** 195 * Clean up the PCI device, then terminate the QEMU instance. 196 */ ahci_shutdown(AHCIQState * ahci)197 static void ahci_shutdown(AHCIQState *ahci) 198 { 199 QOSState *qs = ahci->parent; 200 201 ahci_clean_mem(ahci); 202 free_ahci_device(ahci->dev); 203 g_free(ahci); 204 qtest_shutdown(qs); 205 } 206 207 /** 208 * Boot and fully enable the HBA device. 209 * @see ahci_boot, ahci_pci_enable and ahci_hba_enable. 210 */ 211 G_GNUC_PRINTF(1, 2) ahci_boot_and_enable(const char * cli,...)212 static AHCIQState *ahci_boot_and_enable(const char *cli, ...) 213 { 214 AHCIQState *ahci; 215 va_list ap; 216 uint16_t buff[256]; 217 uint8_t port; 218 uint8_t hello; 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 } 227 228 ahci_pci_enable(ahci); 229 ahci_hba_enable(ahci); 230 /* Initialize test device */ 231 port = ahci_port_select(ahci); 232 ahci_port_clear(ahci, port); 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); 239 240 return ahci; 241 } 242 243 /*** Specification Adherence Tests ***/ 244 245 /** 246 * Implementation for test_pci_spec. Ensures PCI configuration space is sane. 247 */ ahci_test_pci_spec(AHCIQState * ahci)248 static void ahci_test_pci_spec(AHCIQState *ahci) 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. */ 255 data = qpci_config_readw(ahci->dev, PCI_COMMAND); 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 267 data = qpci_config_readw(ahci->dev, PCI_STATUS); 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. */ 280 datal = qpci_config_readl(ahci->dev, PCI_CLASS_REVISION); 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 303 datab = qpci_config_readb(ahci->dev, PCI_CACHE_LINE_SIZE); 304 g_assert_cmphex(datab, ==, 0); 305 306 datab = qpci_config_readb(ahci->dev, PCI_LATENCY_TIMER); 307 g_assert_cmphex(datab, ==, 0); 308 309 /* Only the bottom 7 bits must be off. */ 310 datab = qpci_config_readb(ahci->dev, PCI_HEADER_TYPE); 311 ASSERT_BIT_CLEAR(datab, 0x7F); 312 313 /* BIST is optional, but the low 7 bits must always start off regardless. */ 314 datab = qpci_config_readb(ahci->dev, PCI_BIST); 315 ASSERT_BIT_CLEAR(datab, 0x7F); 316 317 /* BARS 0-4 do not have a boot spec, but ABAR/BAR5 must be clean. */ 318 datal = qpci_config_readl(ahci->dev, PCI_BASE_ADDRESS_5); 319 g_assert_cmphex(datal, ==, 0); 320 321 qpci_config_writel(ahci->dev, PCI_BASE_ADDRESS_5, 0xFFFFFFFF); 322 datal = qpci_config_readl(ahci->dev, PCI_BASE_ADDRESS_5); 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, */ 328 datal = qpci_config_readl(ahci->dev, PCI_CAPABILITY_LIST); 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 extensions. */ 334 data = qpci_config_readw(ahci->dev, datal); 335 336 switch (ahci->fingerprint) { 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. */ 349 datal = qpci_config_readl(ahci->dev, PCI_CAPABILITY_LIST + 4); 350 g_assert_cmphex(datal, ==, 0); 351 352 /* IPIN might vary, but ILINE must be off. */ 353 datab = qpci_config_readb(ahci->dev, PCI_INTERRUPT_LINE); 354 g_assert_cmphex(datab, ==, 0); 355 } 356 357 /** 358 * Test PCI capabilities for AHCI specification adherence. 359 */ ahci_test_pci_caps(AHCIQState * ahci,uint16_t header,uint8_t offset)360 static void ahci_test_pci_caps(AHCIQState *ahci, uint16_t header, 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) { 384 ahci_test_pci_caps(ahci, qpci_config_readw(ahci->dev, next), next); 385 } 386 } 387 388 /** 389 * Test SATA PCI capabilitity for AHCI specification adherence. 390 */ ahci_test_satacap(AHCIQState * ahci,uint8_t offset)391 static void ahci_test_satacap(AHCIQState *ahci, uint8_t offset) 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. */ 399 dataw = qpci_config_readw(ahci->dev, offset + 2); 400 g_assert_cmphex(dataw, ==, 0x10); 401 402 /* Grab the SATACR1 register. */ 403 datal = qpci_config_readw(ahci->dev, offset + 4); 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 */ ahci_test_msicap(AHCIQState * ahci,uint8_t offset)426 static void ahci_test_msicap(AHCIQState *ahci, uint8_t offset) 427 { 428 uint16_t dataw; 429 uint32_t datal; 430 431 g_test_message("Verifying MSICAP"); 432 433 dataw = qpci_config_readw(ahci->dev, offset + PCI_MSI_FLAGS); 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 438 datal = qpci_config_readl(ahci->dev, offset + PCI_MSI_ADDRESS_LO); 439 g_assert_cmphex(datal, ==, 0); 440 441 if (dataw & PCI_MSI_FLAGS_64BIT) { 442 g_test_message("MSICAP is 64bit"); 443 datal = qpci_config_readl(ahci->dev, offset + PCI_MSI_ADDRESS_HI); 444 g_assert_cmphex(datal, ==, 0); 445 dataw = qpci_config_readw(ahci->dev, offset + PCI_MSI_DATA_64); 446 g_assert_cmphex(dataw, ==, 0); 447 } else { 448 g_test_message("MSICAP is 32bit"); 449 dataw = qpci_config_readw(ahci->dev, offset + PCI_MSI_DATA_32); 450 g_assert_cmphex(dataw, ==, 0); 451 } 452 } 453 454 /** 455 * Test Power Management PCI capability for AHCI specification adherence. 456 */ ahci_test_pmcap(AHCIQState * ahci,uint8_t offset)457 static void ahci_test_pmcap(AHCIQState *ahci, uint8_t offset) 458 { 459 uint16_t dataw; 460 461 g_test_message("Verifying PMCAP"); 462 463 dataw = qpci_config_readw(ahci->dev, offset + PCI_PM_PMC); 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 469 dataw = qpci_config_readw(ahci->dev, offset + PCI_PM_CTRL); 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 ahci_test_hba_spec(AHCIQState * ahci)476 static void ahci_test_hba_spec(AHCIQState *ahci) 477 { 478 unsigned i; 479 uint32_t reg; 480 uint32_t ports; 481 uint8_t nports_impl; 482 uint8_t maxports; 483 484 g_assert(ahci != NULL); 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 */ 507 ahci->cap = ahci_rreg(ahci, AHCI_CAP); 508 ASSERT_BIT_CLEAR(ahci->cap, AHCI_CAP_RESERVED); 509 510 /* 2 GHC - Global Host Control */ 511 reg = ahci_rreg(ahci, AHCI_GHC); 512 ASSERT_BIT_CLEAR(reg, AHCI_GHC_HR); 513 ASSERT_BIT_CLEAR(reg, AHCI_GHC_IE); 514 ASSERT_BIT_CLEAR(reg, AHCI_GHC_MRSM); 515 if (BITSET(ahci->cap, AHCI_CAP_SAM)) { 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 */ 524 reg = ahci_rreg(ahci, AHCI_IS); 525 g_assert_cmphex(reg, ==, 0); 526 527 /* 4 PI - Ports Implemented */ 528 ports = ahci_rreg(ahci, AHCI_PI); 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); 533 g_assert_cmpuint(((AHCI_CAP_NP & ahci->cap) + 1), >=, nports_impl); 534 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. */ 538 g_assert_cmphex(ahci->barsize, >, 0); 539 maxports = (ahci->barsize - HBA_DATA_REGION_SIZE) / HBA_PORT_DATA_SIZE; 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 */ 544 reg = ahci_rreg(ahci, AHCI_VS); 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. */ 557 reg = ahci_rreg(ahci, AHCI_CCCCTL); 558 if (BITSET(ahci->cap, AHCI_CAP_CCCS)) { 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 */ 568 reg = ahci_rreg(ahci, AHCI_CCCPORTS); 569 /* Must be zeroes initially regardless of CAP.CCCS */ 570 g_assert_cmphex(reg, ==, 0); 571 572 /* 8 EM_LOC */ 573 reg = ahci_rreg(ahci, AHCI_EMLOC); 574 if (BITCLR(ahci->cap, AHCI_CAP_EMS)) { 575 g_assert_cmphex(reg, ==, 0); 576 } 577 578 /* 9 EM_CTL */ 579 reg = ahci_rreg(ahci, AHCI_EMCTL); 580 if (BITSET(ahci->cap, AHCI_CAP_EMS)) { 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 */ 590 ahci->cap2 = ahci_rreg(ahci, AHCI_CAP2); 591 ASSERT_BIT_CLEAR(ahci->cap2, AHCI_CAP2_RESERVED); 592 593 /* 11 BOHC -- Bios/OS Handoff Control */ 594 reg = ahci_rreg(ahci, AHCI_BOHC); 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) { 600 reg = ahci_rreg(ahci, i); 601 g_assert_cmphex(reg, ==, 0); 602 } 603 604 /* 24 -- 39: NVMHCI */ 605 if (BITCLR(ahci->cap2, AHCI_CAP2_NVMP)) { 606 g_test_message("Verifying HBA/NVMHCI area is empty."); 607 for (i = AHCI_NVMHCI; i < AHCI_VENDOR; ++i) { 608 reg = ahci_rreg(ahci, i); 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) { 616 reg = ahci_rreg(ahci, i); 617 g_assert_cmphex(reg, ==, 0); 618 } 619 620 /* 64 -- XX: Port Space */ 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); 624 ahci_test_port_spec(ahci, i); 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) { 633 reg = ahci_rreg(ahci, j); 634 g_assert_cmphex(reg, ==, 0); 635 } 636 } 637 } 638 } 639 640 /** 641 * Test the memory space for one port for specification adherence. 642 */ ahci_test_port_spec(AHCIQState * ahci,uint8_t port)643 static void ahci_test_port_spec(AHCIQState *ahci, uint8_t port) 644 { 645 uint32_t reg; 646 unsigned i; 647 648 /* (0) CLB */ 649 reg = ahci_px_rreg(ahci, port, AHCI_PX_CLB); 650 ASSERT_BIT_CLEAR(reg, AHCI_PX_CLB_RESERVED); 651 652 /* (1) CLBU */ 653 if (BITCLR(ahci->cap, AHCI_CAP_S64A)) { 654 reg = ahci_px_rreg(ahci, port, AHCI_PX_CLBU); 655 g_assert_cmphex(reg, ==, 0); 656 } 657 658 /* (2) FB */ 659 reg = ahci_px_rreg(ahci, port, AHCI_PX_FB); 660 ASSERT_BIT_CLEAR(reg, AHCI_PX_FB_RESERVED); 661 662 /* (3) FBU */ 663 if (BITCLR(ahci->cap, AHCI_CAP_S64A)) { 664 reg = ahci_px_rreg(ahci, port, AHCI_PX_FBU); 665 g_assert_cmphex(reg, ==, 0); 666 } 667 668 /* (4) IS */ 669 reg = ahci_px_rreg(ahci, port, AHCI_PX_IS); 670 g_assert_cmphex(reg, ==, 0); 671 672 /* (5) IE */ 673 reg = ahci_px_rreg(ahci, port, AHCI_PX_IE); 674 g_assert_cmphex(reg, ==, 0); 675 676 /* (6) CMD */ 677 reg = ahci_px_rreg(ahci, port, AHCI_PX_CMD); 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. */ 699 if (BITCLR(ahci->cap, AHCI_CAP_SMPS)) { 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. */ 704 if (BITANY(reg, AHCI_PX_CMD_CPD | AHCI_PX_CMD_MPSP)) { 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. */ 710 if (BITCLR(ahci->cap, AHCI_CAP_FBSS)) { 711 ASSERT_BIT_CLEAR(reg, AHCI_PX_CMD_FBSCP); 712 } 713 714 /* (7) RESERVED */ 715 reg = ahci_px_rreg(ahci, port, AHCI_PX_RES1); 716 g_assert_cmphex(reg, ==, 0); 717 718 /* (8) TFD */ 719 reg = ahci_px_rreg(ahci, port, AHCI_PX_TFD); 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 */ 737 reg = ahci_px_rreg(ahci, port, AHCI_PX_SSTS); 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 */ 743 reg = ahci_px_rreg(ahci, port, AHCI_PX_SCTL); 744 g_assert_cmphex(reg, ==, 0); 745 746 /* (12) SERR / SCR1: SError */ 747 reg = ahci_px_rreg(ahci, port, AHCI_PX_SERR); 748 g_assert_cmphex(reg, ==, 0); 749 750 /* (13) SACT / SCR3: SActive */ 751 reg = ahci_px_rreg(ahci, port, AHCI_PX_SACT); 752 g_assert_cmphex(reg, ==, 0); 753 754 /* (14) CI */ 755 reg = ahci_px_rreg(ahci, port, AHCI_PX_CI); 756 g_assert_cmphex(reg, ==, 0); 757 758 /* (15) SNTF */ 759 reg = ahci_px_rreg(ahci, port, AHCI_PX_SNTF); 760 g_assert_cmphex(reg, ==, 0); 761 762 /* (16) FBS */ 763 reg = ahci_px_rreg(ahci, port, AHCI_PX_FBS); 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); 770 if (BITSET(ahci->cap, AHCI_CAP_FBSS)) { 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) { 777 reg = ahci_px_rreg(ahci, port, i); 778 g_assert_cmphex(reg, ==, 0); 779 } 780 781 /* [28 -- 31] Vendor-Specific */ 782 for (i = AHCI_PX_VS; i < 32; ++i) { 783 reg = ahci_px_rreg(ahci, port, i); 784 if (reg) { 785 g_test_message("INFO: Vendor register %u non-empty", i); 786 } 787 } 788 } 789 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 */ ahci_test_identify(AHCIQState * ahci)794 static void ahci_test_identify(AHCIQState *ahci) 795 { 796 uint16_t buff[256]; 797 unsigned px; 798 int rc; 799 uint16_t sect_size; 800 const size_t buffsize = 512; 801 802 g_assert(ahci != NULL); 803 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) 810 * (3) Construct an FIS host-to-device command structure, and write it to 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. 823 */ 824 825 /* Pick the first implemented and running port */ 826 px = ahci_port_select(ahci); 827 g_test_message("Selected port %u for test", px); 828 829 /* Clear out the FIS Receive area and any pending interrupts. */ 830 ahci_port_clear(ahci, px); 831 832 /* "Read" 512 bytes using CMD_IDENTIFY into the host buffer. */ 833 ahci_io(ahci, px, CMD_IDENTIFY, &buff, buffsize, 0); 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); 847 848 sect_size = le16_to_cpu(*((uint16_t *)(&buff[5]))); 849 g_assert_cmphex(sect_size, ==, AHCI_SECTOR_SIZE); 850 } 851 ahci_test_io_rw_simple(AHCIQState * ahci,unsigned bufsize,uint64_t sector,uint8_t read_cmd,uint8_t write_cmd)852 static void ahci_test_io_rw_simple(AHCIQState *ahci, unsigned bufsize, 853 uint64_t sector, uint8_t read_cmd, 854 uint8_t write_cmd) 855 { 856 uint64_t ptr; 857 uint8_t port; 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 872 /* Write some indicative pattern to our buffer. */ 873 generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); 874 qtest_bufwrite(ahci->parent->qts, ptr, tx, bufsize); 875 876 /* Write this buffer to disk, then read it back to the DMA buffer. */ 877 ahci_guest_io(ahci, port, write_cmd, ptr, bufsize, sector); 878 qtest_memset(ahci->parent->qts, ptr, 0x00, bufsize); 879 ahci_guest_io(ahci, port, read_cmd, ptr, bufsize, sector); 880 881 /*** Read back the Data ***/ 882 qtest_bufread(ahci->parent->qts, ptr, rx, bufsize); 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 ahci_test_nondata(AHCIQState * ahci,uint8_t ide_cmd)890 static uint8_t ahci_test_nondata(AHCIQState *ahci, uint8_t ide_cmd) 891 { 892 uint8_t port; 893 894 /* Sanitize */ 895 port = ahci_port_select(ahci); 896 ahci_port_clear(ahci, port); 897 898 ahci_io(ahci, port, ide_cmd, NULL, 0, 0); 899 900 return port; 901 } 902 ahci_test_flush(AHCIQState * ahci)903 static void ahci_test_flush(AHCIQState *ahci) 904 { 905 ahci_test_nondata(ahci, CMD_FLUSH_CACHE); 906 } 907 ahci_test_max(AHCIQState * ahci)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; 914 uint64_t config_sect = mb_to_sectors(test_image_size_mb) - 1; 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 qtest_memread(ahci->parent->qts, 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 935 936 /******************************************************************************/ 937 /* Test Interfaces */ 938 /******************************************************************************/ 939 940 /** 941 * Basic sanity test to boot a machine, find an AHCI device, and shutdown. 942 */ test_sanity(void)943 static void test_sanity(void) 944 { 945 AHCIQState *ahci; 946 ahci = ahci_boot(NULL); 947 ahci_shutdown(ahci); 948 } 949 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 */ test_pci_spec(void)954 static void test_pci_spec(void) 955 { 956 AHCIQState *ahci; 957 ahci = ahci_boot(NULL); 958 ahci_test_pci_spec(ahci); 959 ahci_shutdown(ahci); 960 } 961 962 /** 963 * Engage the PCI AHCI device and sanity check the response. 964 * Perform additional PCI config space bringup for the HBA. 965 */ test_pci_enable(void)966 static void test_pci_enable(void) 967 { 968 AHCIQState *ahci; 969 ahci = ahci_boot(NULL); 970 ahci_pci_enable(ahci); 971 ahci_shutdown(ahci); 972 } 973 974 /** 975 * Investigate the memory mapped regions of the HBA, 976 * and test them for AHCI specification adherence. 977 */ test_hba_spec(void)978 static void test_hba_spec(void) 979 { 980 AHCIQState *ahci; 981 982 ahci = ahci_boot(NULL); 983 ahci_pci_enable(ahci); 984 ahci_test_hba_spec(ahci); 985 ahci_shutdown(ahci); 986 } 987 988 /** 989 * Engage the HBA functionality of the AHCI PCI device, 990 * and bring it into a functional idle state. 991 */ test_hba_enable(void)992 static void test_hba_enable(void) 993 { 994 AHCIQState *ahci; 995 996 ahci = ahci_boot(NULL); 997 ahci_pci_enable(ahci); 998 ahci_hba_enable(ahci); 999 ahci_shutdown(ahci); 1000 } 1001 1002 /** 1003 * Bring up the device and issue an IDENTIFY command. 1004 * Inspect the state of the HBA device and the data returned. 1005 */ test_identify(void)1006 static void test_identify(void) 1007 { 1008 AHCIQState *ahci; 1009 1010 ahci = ahci_boot_and_enable(NULL); 1011 ahci_test_identify(ahci); 1012 ahci_shutdown(ahci); 1013 } 1014 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 */ test_dma_fragmented(void)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); 1029 uint64_t ptr; 1030 1031 ahci = ahci_boot_and_enable(NULL); 1032 px = ahci_port_select(ahci); 1033 ahci_port_clear(ahci, px); 1034 1035 /* create pattern */ 1036 generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); 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); 1041 qtest_bufwrite(ahci->parent->qts, ptr, tx, bufsize); 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); 1048 ahci_command_free(cmd); 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); 1055 ahci_command_free(cmd); 1056 1057 /* Read back the guest's receive buffer into local memory */ 1058 qtest_bufread(ahci->parent->qts, ptr, rx, bufsize); 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 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 */ make_dirty(AHCIQState * ahci,uint8_t port)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 test_flush(void)1085 static void test_flush(void) 1086 { 1087 AHCIQState *ahci; 1088 uint8_t port; 1089 1090 ahci = ahci_boot_and_enable(NULL); 1091 1092 port = ahci_port_select(ahci); 1093 ahci_port_clear(ahci, port); 1094 1095 make_dirty(ahci, port); 1096 1097 ahci_test_flush(ahci); 1098 ahci_shutdown(ahci); 1099 } 1100 test_flush_retry(void)1101 static void test_flush_retry(void) 1102 { 1103 AHCIQState *ahci; 1104 AHCICommand *cmd; 1105 uint8_t port; 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," 1109 "format=%s,cache=writeback," 1110 "rerror=stop,werror=stop " 1111 "-M q35 " 1112 "-device ide-hd,drive=drive0 ", 1113 debug_path, 1114 tmp_path, imgfmt); 1115 1116 port = ahci_port_select(ahci); 1117 ahci_port_clear(ahci, port); 1118 1119 /* Issue write so that flush actually goes to disk */ 1120 make_dirty(ahci, port); 1121 1122 /* Issue Flush Command and wait for error */ 1123 cmd = ahci_guest_io_halt(ahci, port, CMD_FLUSH_CACHE, 0, 0, 0); 1124 ahci_guest_io_resume(ahci, cmd); 1125 1126 ahci_shutdown(ahci); 1127 } 1128 1129 /** 1130 * Basic sanity test to boot a machine, find an AHCI device, and shutdown. 1131 */ test_migrate_sanity(void)1132 static void test_migrate_sanity(void) 1133 { 1134 AHCIQState *src, *dst; 1135 char *uri = g_strdup_printf("unix:%s", mig_socket); 1136 1137 src = ahci_boot("-m 384 -M q35 " 1138 "-drive if=ide,file=%s,format=%s ", tmp_path, imgfmt); 1139 dst = ahci_boot("-m 384 -M q35 " 1140 "-drive if=ide,file=%s,format=%s " 1141 "-incoming %s", tmp_path, imgfmt, uri); 1142 1143 ahci_migrate(src, dst, uri); 1144 1145 ahci_shutdown(src); 1146 ahci_shutdown(dst); 1147 g_free(uri); 1148 } 1149 1150 /** 1151 * Simple migration test: Write a pattern, migrate, then read. 1152 */ ahci_migrate_simple(uint8_t cmd_read,uint8_t cmd_write)1153 static void ahci_migrate_simple(uint8_t cmd_read, uint8_t cmd_write) 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); 1160 char *uri = g_strdup_printf("unix:%s", mig_socket); 1161 1162 src = ahci_boot_and_enable("-m 384 -M q35 " 1163 "-drive if=ide,format=%s,file=%s ", 1164 imgfmt, tmp_path); 1165 dst = ahci_boot("-m 384 -M q35 " 1166 "-drive if=ide,format=%s,file=%s " 1167 "-incoming %s", imgfmt, tmp_path, uri); 1168 1169 /* initialize */ 1170 px = ahci_port_select(src); 1171 ahci_port_clear(src, px); 1172 1173 /* create pattern */ 1174 generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); 1175 1176 /* Write, migrate, then read. */ 1177 ahci_io(src, px, cmd_write, tx, bufsize, 0); 1178 ahci_migrate(src, dst, uri); 1179 ahci_io(dst, px, cmd_read, rx, bufsize, 0); 1180 1181 /* Verify pattern */ 1182 g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); 1183 1184 ahci_shutdown(src); 1185 ahci_shutdown(dst); 1186 g_free(rx); 1187 g_free(tx); 1188 g_free(uri); 1189 } 1190 test_migrate_dma(void)1191 static void test_migrate_dma(void) 1192 { 1193 ahci_migrate_simple(CMD_READ_DMA, CMD_WRITE_DMA); 1194 } 1195 test_migrate_ncq(void)1196 static void test_migrate_ncq(void) 1197 { 1198 ahci_migrate_simple(READ_FPDMA_QUEUED, WRITE_FPDMA_QUEUED); 1199 } 1200 1201 /** 1202 * Halted IO Error Test 1203 * 1204 * Simulate an error on first write, Try to write a pattern, 1205 * Confirm the VM has stopped, resume the VM, verify command 1206 * has completed, then read back the data and verify. 1207 */ ahci_halted_io_test(uint8_t cmd_read,uint8_t cmd_write)1208 static void ahci_halted_io_test(uint8_t cmd_read, uint8_t cmd_write) 1209 { 1210 AHCIQState *ahci; 1211 uint8_t port; 1212 size_t bufsize = 4096; 1213 unsigned char *tx = g_malloc(bufsize); 1214 unsigned char *rx = g_malloc0(bufsize); 1215 uint64_t ptr; 1216 AHCICommand *cmd; 1217 1218 prepare_blkdebug_script(debug_path, "write_aio"); 1219 1220 ahci = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," 1221 "format=%s,cache=writeback," 1222 "rerror=stop,werror=stop " 1223 "-M q35 " 1224 "-device ide-hd,drive=drive0 ", 1225 debug_path, 1226 tmp_path, imgfmt); 1227 1228 /* Initialize and prepare */ 1229 port = ahci_port_select(ahci); 1230 ahci_port_clear(ahci, port); 1231 1232 /* create DMA source buffer and write pattern */ 1233 generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); 1234 ptr = ahci_alloc(ahci, bufsize); 1235 g_assert(ptr); 1236 qtest_memwrite(ahci->parent->qts, ptr, tx, bufsize); 1237 1238 /* Attempt to write (and fail) */ 1239 cmd = ahci_guest_io_halt(ahci, port, cmd_write, 1240 ptr, bufsize, 0); 1241 1242 /* Attempt to resume the command */ 1243 ahci_guest_io_resume(ahci, cmd); 1244 ahci_free(ahci, ptr); 1245 1246 /* Read back and verify */ 1247 ahci_io(ahci, port, cmd_read, rx, bufsize, 0); 1248 g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); 1249 1250 /* Cleanup and go home */ 1251 ahci_shutdown(ahci); 1252 g_free(rx); 1253 g_free(tx); 1254 } 1255 test_halted_dma(void)1256 static void test_halted_dma(void) 1257 { 1258 ahci_halted_io_test(CMD_READ_DMA, CMD_WRITE_DMA); 1259 } 1260 test_halted_ncq(void)1261 static void test_halted_ncq(void) 1262 { 1263 ahci_halted_io_test(READ_FPDMA_QUEUED, WRITE_FPDMA_QUEUED); 1264 } 1265 1266 /** 1267 * IO Error Migration Test 1268 * 1269 * Simulate an error on first write, Try to write a pattern, 1270 * Confirm the VM has stopped, migrate, resume the VM, 1271 * verify command has completed, then read back the data and verify. 1272 */ ahci_migrate_halted_io(uint8_t cmd_read,uint8_t cmd_write)1273 static void ahci_migrate_halted_io(uint8_t cmd_read, uint8_t cmd_write) 1274 { 1275 AHCIQState *src, *dst; 1276 uint8_t port; 1277 size_t bufsize = 4096; 1278 unsigned char *tx = g_malloc(bufsize); 1279 unsigned char *rx = g_malloc0(bufsize); 1280 uint64_t ptr; 1281 AHCICommand *cmd; 1282 char *uri = g_strdup_printf("unix:%s", mig_socket); 1283 1284 prepare_blkdebug_script(debug_path, "write_aio"); 1285 1286 src = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," 1287 "format=%s,cache=writeback," 1288 "rerror=stop,werror=stop " 1289 "-M q35 " 1290 "-device ide-hd,drive=drive0 ", 1291 debug_path, 1292 tmp_path, imgfmt); 1293 1294 dst = ahci_boot("-drive file=%s,if=none,id=drive0," 1295 "format=%s,cache=writeback," 1296 "rerror=stop,werror=stop " 1297 "-M q35 " 1298 "-device ide-hd,drive=drive0 " 1299 "-incoming %s", 1300 tmp_path, imgfmt, uri); 1301 1302 /* Initialize and prepare */ 1303 port = ahci_port_select(src); 1304 ahci_port_clear(src, port); 1305 generate_pattern(tx, bufsize, AHCI_SECTOR_SIZE); 1306 1307 /* create DMA source buffer and write pattern */ 1308 ptr = ahci_alloc(src, bufsize); 1309 g_assert(ptr); 1310 qtest_memwrite(src->parent->qts, ptr, tx, bufsize); 1311 1312 /* Write, trigger the VM to stop, migrate, then resume. */ 1313 cmd = ahci_guest_io_halt(src, port, cmd_write, 1314 ptr, bufsize, 0); 1315 ahci_migrate(src, dst, uri); 1316 ahci_guest_io_resume(dst, cmd); 1317 ahci_free(dst, ptr); 1318 1319 /* Read back */ 1320 ahci_io(dst, port, cmd_read, rx, bufsize, 0); 1321 1322 /* Verify TX and RX are identical */ 1323 g_assert_cmphex(memcmp(tx, rx, bufsize), ==, 0); 1324 1325 /* Cleanup and go home. */ 1326 ahci_shutdown(src); 1327 ahci_shutdown(dst); 1328 g_free(rx); 1329 g_free(tx); 1330 g_free(uri); 1331 } 1332 test_migrate_halted_dma(void)1333 static void test_migrate_halted_dma(void) 1334 { 1335 ahci_migrate_halted_io(CMD_READ_DMA, CMD_WRITE_DMA); 1336 } 1337 test_migrate_halted_ncq(void)1338 static void test_migrate_halted_ncq(void) 1339 { 1340 ahci_migrate_halted_io(READ_FPDMA_QUEUED, WRITE_FPDMA_QUEUED); 1341 } 1342 1343 /** 1344 * Migration test: Try to flush, migrate, then resume. 1345 */ test_flush_migrate(void)1346 static void test_flush_migrate(void) 1347 { 1348 AHCIQState *src, *dst; 1349 AHCICommand *cmd; 1350 uint8_t px; 1351 char *uri = g_strdup_printf("unix:%s", mig_socket); 1352 1353 prepare_blkdebug_script(debug_path, "flush_to_disk"); 1354 1355 src = ahci_boot_and_enable("-drive file=blkdebug:%s:%s,if=none,id=drive0," 1356 "cache=writeback,rerror=stop,werror=stop," 1357 "format=%s " 1358 "-M q35 " 1359 "-device ide-hd,drive=drive0 ", 1360 debug_path, tmp_path, imgfmt); 1361 dst = ahci_boot("-drive file=%s,if=none,id=drive0," 1362 "cache=writeback,rerror=stop,werror=stop," 1363 "format=%s " 1364 "-M q35 " 1365 "-device ide-hd,drive=drive0 " 1366 "-incoming %s", tmp_path, imgfmt, uri); 1367 1368 px = ahci_port_select(src); 1369 ahci_port_clear(src, px); 1370 1371 /* Dirty device so that flush reaches disk */ 1372 make_dirty(src, px); 1373 1374 /* Issue Flush Command */ 1375 cmd = ahci_command_create(CMD_FLUSH_CACHE); 1376 ahci_command_commit(src, cmd, px); 1377 ahci_command_issue_async(src, cmd); 1378 qtest_qmp_eventwait(src->parent->qts, "STOP"); 1379 1380 /* Migrate over */ 1381 ahci_migrate(src, dst, uri); 1382 1383 /* Complete the command */ 1384 qtest_qmp_send(dst->parent->qts, "{'execute':'cont' }"); 1385 qtest_qmp_eventwait(dst->parent->qts, "RESUME"); 1386 ahci_command_wait(dst, cmd); 1387 ahci_command_verify(dst, cmd); 1388 1389 ahci_command_free(cmd); 1390 ahci_shutdown(src); 1391 ahci_shutdown(dst); 1392 g_free(uri); 1393 } 1394 test_max(void)1395 static void test_max(void) 1396 { 1397 AHCIQState *ahci; 1398 1399 ahci = ahci_boot_and_enable(NULL); 1400 ahci_test_max(ahci); 1401 ahci_shutdown(ahci); 1402 } 1403 test_reset(void)1404 static void test_reset(void) 1405 { 1406 AHCIQState *ahci; 1407 int i; 1408 1409 ahci = ahci_boot(NULL); 1410 ahci_test_pci_spec(ahci); 1411 ahci_pci_enable(ahci); 1412 1413 for (i = 0; i < 2; i++) { 1414 ahci_test_hba_spec(ahci); 1415 ahci_hba_enable(ahci); 1416 ahci_test_identify(ahci); 1417 ahci_test_io_rw_simple(ahci, 4096, 0, 1418 CMD_READ_DMA_EXT, 1419 CMD_WRITE_DMA_EXT); 1420 ahci_set(ahci, AHCI_GHC, AHCI_GHC_HR); 1421 ahci_clean_mem(ahci); 1422 } 1423 1424 ahci_shutdown(ahci); 1425 } 1426 test_reset_pending_callback(void)1427 static void test_reset_pending_callback(void) 1428 { 1429 AHCIQState *ahci; 1430 AHCICommand *cmd; 1431 uint8_t port; 1432 uint64_t ptr1; 1433 uint64_t ptr2; 1434 1435 int bufsize = 4 * 1024; 1436 int speed = bufsize + (bufsize / 2); 1437 int offset1 = 0; 1438 int offset2 = bufsize / AHCI_SECTOR_SIZE; 1439 1440 g_autofree unsigned char *tx1 = g_malloc(bufsize); 1441 g_autofree unsigned char *tx2 = g_malloc(bufsize); 1442 g_autofree unsigned char *rx1 = g_malloc0(bufsize); 1443 g_autofree unsigned char *rx2 = g_malloc0(bufsize); 1444 1445 /* Uses throttling to make test independent of specific environment. */ 1446 ahci = ahci_boot_and_enable("-drive if=none,id=drive0,file=%s," 1447 "cache=writeback,format=%s," 1448 "throttling.bps-write=%d " 1449 "-M q35 " 1450 "-device ide-hd,drive=drive0 ", 1451 tmp_path, imgfmt, speed); 1452 1453 port = ahci_port_select(ahci); 1454 ahci_port_clear(ahci, port); 1455 1456 ptr1 = ahci_alloc(ahci, bufsize); 1457 ptr2 = ahci_alloc(ahci, bufsize); 1458 1459 g_assert(ptr1 && ptr2); 1460 1461 /* Need two different patterns. */ 1462 do { 1463 generate_pattern(tx1, bufsize, AHCI_SECTOR_SIZE); 1464 generate_pattern(tx2, bufsize, AHCI_SECTOR_SIZE); 1465 } while (memcmp(tx1, tx2, bufsize) == 0); 1466 1467 qtest_bufwrite(ahci->parent->qts, ptr1, tx1, bufsize); 1468 qtest_bufwrite(ahci->parent->qts, ptr2, tx2, bufsize); 1469 1470 /* Write to beginning of disk to check it wasn't overwritten later. */ 1471 ahci_guest_io(ahci, port, CMD_WRITE_DMA_EXT, ptr1, bufsize, offset1); 1472 1473 /* Issue asynchronously to get a pending callback during reset. */ 1474 cmd = ahci_command_create(CMD_WRITE_DMA_EXT); 1475 ahci_command_adjust(cmd, offset2, ptr2, bufsize, 0); 1476 ahci_command_commit(ahci, cmd, port); 1477 ahci_command_issue_async(ahci, cmd); 1478 1479 ahci_set(ahci, AHCI_GHC, AHCI_GHC_HR); 1480 1481 ahci_command_free(cmd); 1482 1483 /* Wait for throttled write to finish. */ 1484 sleep(1); 1485 1486 /* Start again. */ 1487 ahci_clean_mem(ahci); 1488 ahci_pci_enable(ahci); 1489 ahci_hba_enable(ahci); 1490 port = ahci_port_select(ahci); 1491 ahci_port_clear(ahci, port); 1492 1493 /* Read and verify. */ 1494 ahci_guest_io(ahci, port, CMD_READ_DMA_EXT, ptr1, bufsize, offset1); 1495 qtest_bufread(ahci->parent->qts, ptr1, rx1, bufsize); 1496 g_assert_cmphex(memcmp(tx1, rx1, bufsize), ==, 0); 1497 1498 ahci_guest_io(ahci, port, CMD_READ_DMA_EXT, ptr2, bufsize, offset2); 1499 qtest_bufread(ahci->parent->qts, ptr2, rx2, bufsize); 1500 g_assert_cmphex(memcmp(tx2, rx2, bufsize), ==, 0); 1501 1502 ahci_free(ahci, ptr1); 1503 ahci_free(ahci, ptr2); 1504 1505 ahci_clean_mem(ahci); 1506 1507 ahci_shutdown(ahci); 1508 } 1509 test_ncq_simple(void)1510 static void test_ncq_simple(void) 1511 { 1512 AHCIQState *ahci; 1513 1514 ahci = ahci_boot_and_enable(NULL); 1515 ahci_test_io_rw_simple(ahci, 4096, 0, 1516 READ_FPDMA_QUEUED, 1517 WRITE_FPDMA_QUEUED); 1518 ahci_shutdown(ahci); 1519 } 1520 prepare_iso(size_t size,unsigned char ** buf,char ** name)1521 static int prepare_iso(size_t size, unsigned char **buf, char **name) 1522 { 1523 g_autofree char *cdrom_path = NULL; 1524 unsigned char *patt; 1525 ssize_t ret; 1526 int fd = g_file_open_tmp("qtest.iso.XXXXXX", &cdrom_path, NULL); 1527 1528 g_assert(fd != -1); 1529 g_assert(buf); 1530 g_assert(name); 1531 patt = g_malloc(size); 1532 1533 /* Generate a pattern and build a CDROM image to read from */ 1534 generate_pattern(patt, size, ATAPI_SECTOR_SIZE); 1535 ret = write(fd, patt, size); 1536 g_assert(ret == size); 1537 1538 *name = g_strdup(cdrom_path); 1539 *buf = patt; 1540 return fd; 1541 } 1542 remove_iso(int fd,char * name)1543 static void remove_iso(int fd, char *name) 1544 { 1545 unlink(name); 1546 g_free(name); 1547 close(fd); 1548 } 1549 ahci_cb_cmp_buff(AHCIQState * ahci,AHCICommand * cmd,const AHCIOpts * opts)1550 static int ahci_cb_cmp_buff(AHCIQState *ahci, AHCICommand *cmd, 1551 const AHCIOpts *opts) 1552 { 1553 unsigned char *tx = opts->opaque; 1554 unsigned char *rx; 1555 1556 if (!opts->size) { 1557 return 0; 1558 } 1559 1560 rx = g_malloc0(opts->size); 1561 qtest_bufread(ahci->parent->qts, opts->buffer, rx, opts->size); 1562 g_assert_cmphex(memcmp(tx, rx, opts->size), ==, 0); 1563 g_free(rx); 1564 1565 return 0; 1566 } 1567 ahci_test_cdrom(int nsectors,bool dma,uint8_t cmd,bool override_bcl,uint16_t bcl)1568 static void ahci_test_cdrom(int nsectors, bool dma, uint8_t cmd, 1569 bool override_bcl, uint16_t bcl) 1570 { 1571 AHCIQState *ahci; 1572 unsigned char *tx; 1573 char *iso; 1574 int fd; 1575 AHCIOpts opts = { 1576 .size = ((uint64_t)ATAPI_SECTOR_SIZE * nsectors), 1577 .atapi = true, 1578 .atapi_dma = dma, 1579 .post_cb = ahci_cb_cmp_buff, 1580 .set_bcl = override_bcl, 1581 .bcl = bcl, 1582 }; 1583 uint64_t iso_size = (uint64_t)ATAPI_SECTOR_SIZE * (nsectors + 1); 1584 1585 /* Prepare ISO and fill 'tx' buffer */ 1586 fd = prepare_iso(iso_size, &tx, &iso); 1587 opts.opaque = tx; 1588 1589 /* Standard startup wonkery, but use ide-cd and our special iso file */ 1590 ahci = ahci_boot_and_enable("-drive if=none,id=drive0,file=%s,format=raw " 1591 "-M q35 " 1592 "-device ide-cd,drive=drive0 ", iso); 1593 1594 /* Build & Send AHCI command */ 1595 ahci_exec(ahci, ahci_port_select(ahci), cmd, &opts); 1596 1597 /* Cleanup */ 1598 g_free(tx); 1599 ahci_shutdown(ahci); 1600 remove_iso(fd, iso); 1601 } 1602 ahci_test_cdrom_read10(int nsectors,bool dma)1603 static void ahci_test_cdrom_read10(int nsectors, bool dma) 1604 { 1605 ahci_test_cdrom(nsectors, dma, CMD_ATAPI_READ_10, false, 0); 1606 } 1607 test_cdrom_dma(void)1608 static void test_cdrom_dma(void) 1609 { 1610 ahci_test_cdrom_read10(1, true); 1611 } 1612 test_cdrom_dma_multi(void)1613 static void test_cdrom_dma_multi(void) 1614 { 1615 ahci_test_cdrom_read10(3, true); 1616 } 1617 test_cdrom_pio(void)1618 static void test_cdrom_pio(void) 1619 { 1620 ahci_test_cdrom_read10(1, false); 1621 } 1622 test_cdrom_pio_multi(void)1623 static void test_cdrom_pio_multi(void) 1624 { 1625 ahci_test_cdrom_read10(3, false); 1626 } 1627 1628 /* Regression test: Test that a READ_CD command with a BCL of 0 but a size of 0 1629 * completes as a NOP instead of erroring out. */ test_atapi_bcl(void)1630 static void test_atapi_bcl(void) 1631 { 1632 ahci_test_cdrom(0, false, CMD_ATAPI_READ_CD, true, 0); 1633 } 1634 1635 atapi_wait_tray(AHCIQState * ahci,bool open)1636 static void atapi_wait_tray(AHCIQState *ahci, bool open) 1637 { 1638 QDict *rsp = qtest_qmp_eventwait_ref(ahci->parent->qts, 1639 "DEVICE_TRAY_MOVED"); 1640 QDict *data = qdict_get_qdict(rsp, "data"); 1641 if (open) { 1642 g_assert(qdict_get_bool(data, "tray-open")); 1643 } else { 1644 g_assert(!qdict_get_bool(data, "tray-open")); 1645 } 1646 qobject_unref(rsp); 1647 } 1648 test_atapi_tray(void)1649 static void test_atapi_tray(void) 1650 { 1651 AHCIQState *ahci; 1652 unsigned char *tx; 1653 char *iso; 1654 int fd; 1655 uint8_t port, sense, asc; 1656 uint64_t iso_size = ATAPI_SECTOR_SIZE; 1657 QDict *rsp; 1658 1659 fd = prepare_iso(iso_size, &tx, &iso); 1660 ahci = ahci_boot_and_enable("-blockdev node-name=drive0,driver=file,filename=%s " 1661 "-M q35 " 1662 "-device ide-cd,id=cd0,drive=drive0 ", iso); 1663 port = ahci_port_select(ahci); 1664 1665 ahci_atapi_eject(ahci, port); 1666 atapi_wait_tray(ahci, true); 1667 1668 ahci_atapi_load(ahci, port); 1669 atapi_wait_tray(ahci, false); 1670 1671 /* Remove media */ 1672 qtest_qmp_send(ahci->parent->qts, "{'execute': 'blockdev-open-tray', " 1673 "'arguments': {'id': 'cd0'}}"); 1674 atapi_wait_tray(ahci, true); 1675 rsp = qtest_qmp_receive(ahci->parent->qts); 1676 qobject_unref(rsp); 1677 1678 qtest_qmp_assert_success(ahci->parent->qts, 1679 "{'execute': 'blockdev-remove-medium', " 1680 "'arguments': {'id': 'cd0'}}"); 1681 1682 /* Test the tray without a medium */ 1683 ahci_atapi_load(ahci, port); 1684 atapi_wait_tray(ahci, false); 1685 1686 ahci_atapi_eject(ahci, port); 1687 atapi_wait_tray(ahci, true); 1688 1689 /* Re-insert media */ 1690 qtest_qmp_assert_success( 1691 ahci->parent->qts, 1692 "{'execute': 'blockdev-add', " 1693 "'arguments': {'node-name': 'node0', " 1694 "'driver': 'raw', " 1695 "'file': { 'driver': 'file', " 1696 "'filename': %s }}}", iso); 1697 qtest_qmp_assert_success( 1698 ahci->parent->qts, 1699 "{'execute': 'blockdev-insert-medium'," 1700 "'arguments': { 'id': 'cd0', " 1701 "'node-name': 'node0' }}"); 1702 1703 /* Again, the event shows up first */ 1704 qtest_qmp_send(ahci->parent->qts, "{'execute': 'blockdev-close-tray', " 1705 "'arguments': {'id': 'cd0'}}"); 1706 atapi_wait_tray(ahci, false); 1707 rsp = qtest_qmp_receive(ahci->parent->qts); 1708 qobject_unref(rsp); 1709 1710 /* Now, to convince ATAPI we understand the media has changed... */ 1711 ahci_atapi_test_ready(ahci, port, false, SENSE_NOT_READY); 1712 ahci_atapi_get_sense(ahci, port, &sense, &asc); 1713 g_assert_cmpuint(sense, ==, SENSE_NOT_READY); 1714 g_assert_cmpuint(asc, ==, ASC_MEDIUM_NOT_PRESENT); 1715 1716 ahci_atapi_test_ready(ahci, port, false, SENSE_UNIT_ATTENTION); 1717 ahci_atapi_get_sense(ahci, port, &sense, &asc); 1718 g_assert_cmpuint(sense, ==, SENSE_UNIT_ATTENTION); 1719 g_assert_cmpuint(asc, ==, ASC_MEDIUM_MAY_HAVE_CHANGED); 1720 1721 ahci_atapi_test_ready(ahci, port, true, SENSE_NO_SENSE); 1722 ahci_atapi_get_sense(ahci, port, &sense, &asc); 1723 g_assert_cmpuint(sense, ==, SENSE_NO_SENSE); 1724 1725 /* Final tray test. */ 1726 ahci_atapi_eject(ahci, port); 1727 atapi_wait_tray(ahci, true); 1728 1729 ahci_atapi_load(ahci, port); 1730 atapi_wait_tray(ahci, false); 1731 1732 /* Cleanup */ 1733 g_free(tx); 1734 ahci_shutdown(ahci); 1735 remove_iso(fd, iso); 1736 } 1737 1738 /******************************************************************************/ 1739 /* AHCI I/O Test Matrix Definitions */ 1740 1741 enum BuffLen { 1742 LEN_BEGIN = 0, 1743 LEN_SIMPLE = LEN_BEGIN, 1744 LEN_DOUBLE, 1745 LEN_LONG, 1746 LEN_SHORT, 1747 NUM_LENGTHS 1748 }; 1749 1750 static const char *buff_len_str[NUM_LENGTHS] = { "simple", "double", 1751 "long", "short" }; 1752 1753 enum AddrMode { 1754 ADDR_MODE_BEGIN = 0, 1755 ADDR_MODE_LBA28 = ADDR_MODE_BEGIN, 1756 ADDR_MODE_LBA48, 1757 NUM_ADDR_MODES 1758 }; 1759 1760 static const char *addr_mode_str[NUM_ADDR_MODES] = { "lba28", "lba48" }; 1761 1762 enum IOMode { 1763 MODE_BEGIN = 0, 1764 MODE_PIO = MODE_BEGIN, 1765 MODE_DMA, 1766 NUM_MODES 1767 }; 1768 1769 static const char *io_mode_str[NUM_MODES] = { "pio", "dma" }; 1770 1771 enum IOOps { 1772 IO_BEGIN = 0, 1773 IO_READ = IO_BEGIN, 1774 IO_WRITE, 1775 NUM_IO_OPS 1776 }; 1777 1778 enum OffsetType { 1779 OFFSET_BEGIN = 0, 1780 OFFSET_ZERO = OFFSET_BEGIN, 1781 OFFSET_LOW, 1782 OFFSET_HIGH, 1783 NUM_OFFSETS 1784 }; 1785 1786 static const char *offset_str[NUM_OFFSETS] = { "zero", "low", "high" }; 1787 1788 typedef struct AHCIIOTestOptions { 1789 enum BuffLen length; 1790 enum AddrMode address_type; 1791 enum IOMode io_type; 1792 enum OffsetType offset; 1793 } AHCIIOTestOptions; 1794 offset_sector(enum OffsetType ofst,enum AddrMode addr_type,uint64_t buffsize)1795 static uint64_t offset_sector(enum OffsetType ofst, 1796 enum AddrMode addr_type, 1797 uint64_t buffsize) 1798 { 1799 uint64_t ceil; 1800 uint64_t nsectors; 1801 1802 switch (ofst) { 1803 case OFFSET_ZERO: 1804 return 0; 1805 case OFFSET_LOW: 1806 return 1; 1807 case OFFSET_HIGH: 1808 ceil = (addr_type == ADDR_MODE_LBA28) ? 0xfffffff : 0xffffffffffff; 1809 ceil = MIN(ceil, mb_to_sectors(test_image_size_mb) - 1); 1810 nsectors = buffsize / AHCI_SECTOR_SIZE; 1811 return ceil - nsectors + 1; 1812 default: 1813 g_assert_not_reached(); 1814 } 1815 } 1816 1817 /** 1818 * Table of possible I/O ATA commands given a set of enumerations. 1819 */ 1820 static const uint8_t io_cmds[NUM_MODES][NUM_ADDR_MODES][NUM_IO_OPS] = { 1821 [MODE_PIO] = { 1822 [ADDR_MODE_LBA28] = { 1823 [IO_READ] = CMD_READ_PIO, 1824 [IO_WRITE] = CMD_WRITE_PIO }, 1825 [ADDR_MODE_LBA48] = { 1826 [IO_READ] = CMD_READ_PIO_EXT, 1827 [IO_WRITE] = CMD_WRITE_PIO_EXT } 1828 }, 1829 [MODE_DMA] = { 1830 [ADDR_MODE_LBA28] = { 1831 [IO_READ] = CMD_READ_DMA, 1832 [IO_WRITE] = CMD_WRITE_DMA }, 1833 [ADDR_MODE_LBA48] = { 1834 [IO_READ] = CMD_READ_DMA_EXT, 1835 [IO_WRITE] = CMD_WRITE_DMA_EXT } 1836 } 1837 }; 1838 1839 /** 1840 * Test a Read/Write pattern using various commands, addressing modes, 1841 * transfer modes, and buffer sizes. 1842 */ test_io_rw_interface(enum AddrMode lba48,enum IOMode dma,unsigned bufsize,uint64_t sector)1843 static void test_io_rw_interface(enum AddrMode lba48, enum IOMode dma, 1844 unsigned bufsize, uint64_t sector) 1845 { 1846 AHCIQState *ahci; 1847 1848 ahci = ahci_boot_and_enable(NULL); 1849 ahci_test_io_rw_simple(ahci, bufsize, sector, 1850 io_cmds[dma][lba48][IO_READ], 1851 io_cmds[dma][lba48][IO_WRITE]); 1852 ahci_shutdown(ahci); 1853 } 1854 1855 /** 1856 * Demultiplex the test data and invoke the actual test routine. 1857 */ test_io_interface(gconstpointer opaque)1858 static void test_io_interface(gconstpointer opaque) 1859 { 1860 AHCIIOTestOptions *opts = (AHCIIOTestOptions *)opaque; 1861 unsigned bufsize; 1862 uint64_t sector; 1863 1864 switch (opts->length) { 1865 case LEN_SIMPLE: 1866 bufsize = 4096; 1867 break; 1868 case LEN_DOUBLE: 1869 bufsize = 8192; 1870 break; 1871 case LEN_LONG: 1872 bufsize = 4096 * 64; 1873 break; 1874 case LEN_SHORT: 1875 bufsize = 512; 1876 break; 1877 default: 1878 g_assert_not_reached(); 1879 } 1880 1881 sector = offset_sector(opts->offset, opts->address_type, bufsize); 1882 test_io_rw_interface(opts->address_type, opts->io_type, bufsize, sector); 1883 g_free(opts); 1884 return; 1885 } 1886 create_ahci_io_test(enum IOMode type,enum AddrMode addr,enum BuffLen len,enum OffsetType offset)1887 static void create_ahci_io_test(enum IOMode type, enum AddrMode addr, 1888 enum BuffLen len, enum OffsetType offset) 1889 { 1890 char *name; 1891 AHCIIOTestOptions *opts; 1892 1893 opts = g_new(AHCIIOTestOptions, 1); 1894 opts->length = len; 1895 opts->address_type = addr; 1896 opts->io_type = type; 1897 opts->offset = offset; 1898 1899 name = g_strdup_printf("ahci/io/%s/%s/%s/%s", 1900 io_mode_str[type], 1901 addr_mode_str[addr], 1902 buff_len_str[len], 1903 offset_str[offset]); 1904 1905 if ((addr == ADDR_MODE_LBA48) && (offset == OFFSET_HIGH) && 1906 (mb_to_sectors(test_image_size_mb) <= 0xFFFFFFF)) { 1907 g_test_message("%s: skipped; test image too small", name); 1908 g_free(opts); 1909 g_free(name); 1910 return; 1911 } 1912 1913 qtest_add_data_func(name, opts, test_io_interface); 1914 g_free(name); 1915 } 1916 1917 /******************************************************************************/ 1918 main(int argc,char ** argv)1919 int main(int argc, char **argv) 1920 { 1921 const char *arch, *base; 1922 int ret; 1923 int fd; 1924 int c; 1925 int i, j, k, m; 1926 1927 static struct option long_options[] = { 1928 {"pedantic", no_argument, 0, 'p' }, 1929 {0, 0, 0, 0}, 1930 }; 1931 1932 /* Should be first to utilize g_test functionality, So we can see errors. */ 1933 g_test_init(&argc, &argv, NULL); 1934 1935 while (1) { 1936 c = getopt_long(argc, argv, "", long_options, NULL); 1937 if (c == -1) { 1938 break; 1939 } 1940 switch (c) { 1941 case -1: 1942 break; 1943 case 'p': 1944 ahci_pedantic = 1; 1945 break; 1946 default: 1947 fprintf(stderr, "Unrecognized ahci_test option.\n"); 1948 g_assert_not_reached(); 1949 } 1950 } 1951 1952 /* Check architecture */ 1953 arch = qtest_get_arch(); 1954 if (strcmp(arch, "i386") && strcmp(arch, "x86_64")) { 1955 g_test_message("Skipping test for non-x86"); 1956 return 0; 1957 } 1958 1959 /* 1960 * "base" stores the starting point where we create temporary files. 1961 * 1962 * On Windows, this is set to the relative path of current working 1963 * directory, because the absolute path causes the blkdebug filename 1964 * parser fail to parse "blkdebug:path/to/config:path/to/image". 1965 */ 1966 #ifndef _WIN32 1967 base = g_get_tmp_dir(); 1968 #else 1969 base = "."; 1970 #endif 1971 1972 /* Create a temporary image */ 1973 tmp_path = g_strdup_printf("%s/qtest.XXXXXX", base); 1974 fd = g_mkstemp(tmp_path); 1975 g_assert(fd >= 0); 1976 if (have_qemu_img()) { 1977 imgfmt = "qcow2"; 1978 test_image_size_mb = TEST_IMAGE_SIZE_MB_LARGE; 1979 mkqcow2(tmp_path, TEST_IMAGE_SIZE_MB_LARGE); 1980 } else { 1981 g_test_message("QTEST_QEMU_IMG not set or qemu-img missing; " 1982 "skipping LBA48 high-sector tests"); 1983 imgfmt = "raw"; 1984 test_image_size_mb = TEST_IMAGE_SIZE_MB_SMALL; 1985 ret = ftruncate(fd, test_image_size_mb * 1024 * 1024); 1986 g_assert(ret == 0); 1987 } 1988 close(fd); 1989 1990 /* Create temporary blkdebug instructions */ 1991 debug_path = g_strdup_printf("%s/qtest-blkdebug.XXXXXX", base); 1992 fd = g_mkstemp(debug_path); 1993 g_assert(fd >= 0); 1994 close(fd); 1995 1996 /* Reserve a hollow file to use as a socket for migration tests */ 1997 fd = g_file_open_tmp("qtest-migration.XXXXXX", &mig_socket, NULL); 1998 g_assert(fd >= 0); 1999 close(fd); 2000 2001 /* Run the tests */ 2002 qtest_add_func("/ahci/sanity", test_sanity); 2003 qtest_add_func("/ahci/pci_spec", test_pci_spec); 2004 qtest_add_func("/ahci/pci_enable", test_pci_enable); 2005 qtest_add_func("/ahci/hba_spec", test_hba_spec); 2006 qtest_add_func("/ahci/hba_enable", test_hba_enable); 2007 qtest_add_func("/ahci/identify", test_identify); 2008 2009 for (i = MODE_BEGIN; i < NUM_MODES; i++) { 2010 for (j = ADDR_MODE_BEGIN; j < NUM_ADDR_MODES; j++) { 2011 for (k = LEN_BEGIN; k < NUM_LENGTHS; k++) { 2012 for (m = OFFSET_BEGIN; m < NUM_OFFSETS; m++) { 2013 create_ahci_io_test(i, j, k, m); 2014 } 2015 } 2016 } 2017 } 2018 2019 qtest_add_func("/ahci/io/dma/lba28/fragmented", test_dma_fragmented); 2020 2021 qtest_add_func("/ahci/flush/simple", test_flush); 2022 qtest_add_func("/ahci/flush/retry", test_flush_retry); 2023 qtest_add_func("/ahci/flush/migrate", test_flush_migrate); 2024 2025 qtest_add_func("/ahci/migrate/sanity", test_migrate_sanity); 2026 qtest_add_func("/ahci/migrate/dma/simple", test_migrate_dma); 2027 qtest_add_func("/ahci/io/dma/lba28/retry", test_halted_dma); 2028 qtest_add_func("/ahci/migrate/dma/halted", test_migrate_halted_dma); 2029 2030 qtest_add_func("/ahci/max", test_max); 2031 qtest_add_func("/ahci/reset/simple", test_reset); 2032 qtest_add_func("/ahci/reset/pending_callback", test_reset_pending_callback); 2033 2034 qtest_add_func("/ahci/io/ncq/simple", test_ncq_simple); 2035 qtest_add_func("/ahci/migrate/ncq/simple", test_migrate_ncq); 2036 qtest_add_func("/ahci/io/ncq/retry", test_halted_ncq); 2037 qtest_add_func("/ahci/migrate/ncq/halted", test_migrate_halted_ncq); 2038 2039 qtest_add_func("/ahci/cdrom/dma/single", test_cdrom_dma); 2040 qtest_add_func("/ahci/cdrom/dma/multi", test_cdrom_dma_multi); 2041 qtest_add_func("/ahci/cdrom/pio/single", test_cdrom_pio); 2042 qtest_add_func("/ahci/cdrom/pio/multi", test_cdrom_pio_multi); 2043 2044 qtest_add_func("/ahci/cdrom/pio/bcl", test_atapi_bcl); 2045 qtest_add_func("/ahci/cdrom/eject", test_atapi_tray); 2046 2047 ret = g_test_run(); 2048 2049 /* Cleanup */ 2050 unlink(tmp_path); 2051 g_free(tmp_path); 2052 unlink(debug_path); 2053 g_free(debug_path); 2054 unlink(mig_socket); 2055 g_free(mig_socket); 2056 2057 return ret; 2058 } 2059