qemu

FORK: QEMU emulator
git clone https://git.neptards.moe/neptards/qemu.git
Log | Files | Refs | Submodules | LICENSE

ahci.h (22404B)


      1 #ifndef LIBQOS_AHCI_H
      2 #define LIBQOS_AHCI_H
      3 
      4 /*
      5  * AHCI qtest library functions and definitions
      6  *
      7  * Copyright (c) 2014 John Snow <jsnow@redhat.com>
      8  *
      9  * Permission is hereby granted, free of charge, to any person obtaining a copy
     10  * of this software and associated documentation files (the "Software"), to deal
     11  * in the Software without restriction, including without limitation the rights
     12  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
     13  * copies of the Software, and to permit persons to whom the Software is
     14  * furnished to do so, subject to the following conditions:
     15  *
     16  * The above copyright notice and this permission notice shall be included in
     17  * all copies or substantial portions of the Software.
     18  *
     19  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     20  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     21  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
     22  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
     23  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
     24  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
     25  * THE SOFTWARE.
     26  */
     27 
     28 #include "libqos.h"
     29 #include "pci.h"
     30 #include "malloc-pc.h"
     31 
     32 /*** Supplementary PCI Config Space IDs & Masks ***/
     33 #define PCI_DEVICE_ID_INTEL_Q35_AHCI   (0x2922)
     34 #define PCI_MSI_FLAGS_RESERVED         (0xFF00)
     35 #define PCI_PM_CTRL_RESERVED             (0xFC)
     36 #define PCI_BCC(REG32)          ((REG32) >> 24)
     37 #define PCI_PI(REG32)   (((REG32) >> 8) & 0xFF)
     38 #define PCI_SCC(REG32) (((REG32) >> 16) & 0xFF)
     39 
     40 /*** Recognized AHCI Device Types ***/
     41 #define AHCI_INTEL_ICH9 (PCI_DEVICE_ID_INTEL_Q35_AHCI << 16 | \
     42                          PCI_VENDOR_ID_INTEL)
     43 
     44 /*** AHCI/HBA Register Offsets and Bitmasks ***/
     45 #define AHCI_CAP                          (0)
     46 #define AHCI_CAP_NP                    (0x1F)
     47 #define AHCI_CAP_SXS                   (0x20)
     48 #define AHCI_CAP_EMS                   (0x40)
     49 #define AHCI_CAP_CCCS                  (0x80)
     50 #define AHCI_CAP_NCS                 (0x1F00)
     51 #define AHCI_CAP_PSC                 (0x2000)
     52 #define AHCI_CAP_SSC                 (0x4000)
     53 #define AHCI_CAP_PMD                 (0x8000)
     54 #define AHCI_CAP_FBSS               (0x10000)
     55 #define AHCI_CAP_SPM                (0x20000)
     56 #define AHCI_CAP_SAM                (0x40000)
     57 #define AHCI_CAP_RESERVED           (0x80000)
     58 #define AHCI_CAP_ISS               (0xF00000)
     59 #define AHCI_CAP_SCLO             (0x1000000)
     60 #define AHCI_CAP_SAL              (0x2000000)
     61 #define AHCI_CAP_SALP             (0x4000000)
     62 #define AHCI_CAP_SSS              (0x8000000)
     63 #define AHCI_CAP_SMPS            (0x10000000)
     64 #define AHCI_CAP_SSNTF           (0x20000000)
     65 #define AHCI_CAP_SNCQ            (0x40000000)
     66 #define AHCI_CAP_S64A            (0x80000000)
     67 
     68 #define AHCI_GHC                          (1)
     69 #define AHCI_GHC_HR                    (0x01)
     70 #define AHCI_GHC_IE                    (0x02)
     71 #define AHCI_GHC_MRSM                  (0x04)
     72 #define AHCI_GHC_RESERVED        (0x7FFFFFF8)
     73 #define AHCI_GHC_AE              (0x80000000)
     74 
     75 #define AHCI_IS                           (2)
     76 #define AHCI_PI                           (3)
     77 #define AHCI_VS                           (4)
     78 
     79 #define AHCI_CCCCTL                       (5)
     80 #define AHCI_CCCCTL_EN                 (0x01)
     81 #define AHCI_CCCCTL_RESERVED           (0x06)
     82 #define AHCI_CCCCTL_CC               (0xFF00)
     83 #define AHCI_CCCCTL_TV           (0xFFFF0000)
     84 
     85 #define AHCI_CCCPORTS                     (6)
     86 #define AHCI_EMLOC                        (7)
     87 
     88 #define AHCI_EMCTL                        (8)
     89 #define AHCI_EMCTL_STSMR               (0x01)
     90 #define AHCI_EMCTL_CTLTM              (0x100)
     91 #define AHCI_EMCTL_CTLRST             (0x200)
     92 #define AHCI_EMCTL_RESERVED      (0xF0F0FCFE)
     93 
     94 #define AHCI_CAP2                         (9)
     95 #define AHCI_CAP2_BOH                  (0x01)
     96 #define AHCI_CAP2_NVMP                 (0x02)
     97 #define AHCI_CAP2_APST                 (0x04)
     98 #define AHCI_CAP2_RESERVED       (0xFFFFFFF8)
     99 
    100 #define AHCI_BOHC                        (10)
    101 #define AHCI_RESERVED                    (11)
    102 #define AHCI_NVMHCI                      (24)
    103 #define AHCI_VENDOR                      (40)
    104 #define AHCI_PORTS                       (64)
    105 
    106 /*** Port Memory Offsets & Bitmasks ***/
    107 #define AHCI_PX_CLB                       (0)
    108 #define AHCI_PX_CLB_RESERVED          (0x1FF)
    109 
    110 #define AHCI_PX_CLBU                      (1)
    111 
    112 #define AHCI_PX_FB                        (2)
    113 #define AHCI_PX_FB_RESERVED            (0xFF)
    114 
    115 #define AHCI_PX_FBU                       (3)
    116 
    117 #define AHCI_PX_IS                        (4)
    118 #define AHCI_PX_IS_DHRS                 (0x1)
    119 #define AHCI_PX_IS_PSS                  (0x2)
    120 #define AHCI_PX_IS_DSS                  (0x4)
    121 #define AHCI_PX_IS_SDBS                 (0x8)
    122 #define AHCI_PX_IS_UFS                 (0x10)
    123 #define AHCI_PX_IS_DPS                 (0x20)
    124 #define AHCI_PX_IS_PCS                 (0x40)
    125 #define AHCI_PX_IS_DMPS                (0x80)
    126 #define AHCI_PX_IS_RESERVED       (0x23FFF00)
    127 #define AHCI_PX_IS_PRCS            (0x400000)
    128 #define AHCI_PX_IS_IPMS            (0x800000)
    129 #define AHCI_PX_IS_OFS            (0x1000000)
    130 #define AHCI_PX_IS_INFS           (0x4000000)
    131 #define AHCI_PX_IS_IFS            (0x8000000)
    132 #define AHCI_PX_IS_HBDS          (0x10000000)
    133 #define AHCI_PX_IS_HBFS          (0x20000000)
    134 #define AHCI_PX_IS_TFES          (0x40000000)
    135 #define AHCI_PX_IS_CPDS          (0x80000000)
    136 
    137 #define AHCI_PX_IE                        (5)
    138 #define AHCI_PX_IE_DHRE                 (0x1)
    139 #define AHCI_PX_IE_PSE                  (0x2)
    140 #define AHCI_PX_IE_DSE                  (0x4)
    141 #define AHCI_PX_IE_SDBE                 (0x8)
    142 #define AHCI_PX_IE_UFE                 (0x10)
    143 #define AHCI_PX_IE_DPE                 (0x20)
    144 #define AHCI_PX_IE_PCE                 (0x40)
    145 #define AHCI_PX_IE_DMPE                (0x80)
    146 #define AHCI_PX_IE_RESERVED       (0x23FFF00)
    147 #define AHCI_PX_IE_PRCE            (0x400000)
    148 #define AHCI_PX_IE_IPME            (0x800000)
    149 #define AHCI_PX_IE_OFE            (0x1000000)
    150 #define AHCI_PX_IE_INFE           (0x4000000)
    151 #define AHCI_PX_IE_IFE            (0x8000000)
    152 #define AHCI_PX_IE_HBDE          (0x10000000)
    153 #define AHCI_PX_IE_HBFE          (0x20000000)
    154 #define AHCI_PX_IE_TFEE          (0x40000000)
    155 #define AHCI_PX_IE_CPDE          (0x80000000)
    156 
    157 #define AHCI_PX_CMD                       (6)
    158 #define AHCI_PX_CMD_ST                  (0x1)
    159 #define AHCI_PX_CMD_SUD                 (0x2)
    160 #define AHCI_PX_CMD_POD                 (0x4)
    161 #define AHCI_PX_CMD_CLO                 (0x8)
    162 #define AHCI_PX_CMD_FRE                (0x10)
    163 #define AHCI_PX_CMD_RESERVED           (0xE0)
    164 #define AHCI_PX_CMD_CCS              (0x1F00)
    165 #define AHCI_PX_CMD_MPSS             (0x2000)
    166 #define AHCI_PX_CMD_FR               (0x4000)
    167 #define AHCI_PX_CMD_CR               (0x8000)
    168 #define AHCI_PX_CMD_CPS             (0x10000)
    169 #define AHCI_PX_CMD_PMA             (0x20000)
    170 #define AHCI_PX_CMD_HPCP            (0x40000)
    171 #define AHCI_PX_CMD_MPSP            (0x80000)
    172 #define AHCI_PX_CMD_CPD            (0x100000)
    173 #define AHCI_PX_CMD_ESP            (0x200000)
    174 #define AHCI_PX_CMD_FBSCP          (0x400000)
    175 #define AHCI_PX_CMD_APSTE          (0x800000)
    176 #define AHCI_PX_CMD_ATAPI         (0x1000000)
    177 #define AHCI_PX_CMD_DLAE          (0x2000000)
    178 #define AHCI_PX_CMD_ALPE          (0x4000000)
    179 #define AHCI_PX_CMD_ASP           (0x8000000)
    180 #define AHCI_PX_CMD_ICC          (0xF0000000)
    181 
    182 #define AHCI_PX_RES1                      (7)
    183 
    184 #define AHCI_PX_TFD                       (8)
    185 #define AHCI_PX_TFD_STS                (0xFF)
    186 #define AHCI_PX_TFD_STS_ERR            (0x01)
    187 #define AHCI_PX_TFD_STS_CS1            (0x06)
    188 #define AHCI_PX_TFD_STS_DRQ            (0x08)
    189 #define AHCI_PX_TFD_STS_CS2            (0x70)
    190 #define AHCI_PX_TFD_STS_BSY            (0x80)
    191 #define AHCI_PX_TFD_ERR              (0xFF00)
    192 #define AHCI_PX_TFD_RESERVED     (0xFFFF0000)
    193 
    194 #define AHCI_PX_SIG                       (9)
    195 #define AHCI_PX_SIG_SECTOR_COUNT       (0xFF)
    196 #define AHCI_PX_SIG_LBA_LOW          (0xFF00)
    197 #define AHCI_PX_SIG_LBA_MID        (0xFF0000)
    198 #define AHCI_PX_SIG_LBA_HIGH     (0xFF000000)
    199 
    200 #define AHCI_PX_SSTS                     (10)
    201 #define AHCI_PX_SSTS_DET               (0x0F)
    202 #define AHCI_PX_SSTS_SPD               (0xF0)
    203 #define AHCI_PX_SSTS_IPM              (0xF00)
    204 #define AHCI_PX_SSTS_RESERVED    (0xFFFFF000)
    205 #define SSTS_DET_NO_DEVICE             (0x00)
    206 #define SSTS_DET_PRESENT               (0x01)
    207 #define SSTS_DET_ESTABLISHED           (0x03)
    208 #define SSTS_DET_OFFLINE               (0x04)
    209 
    210 #define AHCI_PX_SCTL                     (11)
    211 
    212 #define AHCI_PX_SERR                     (12)
    213 #define AHCI_PX_SERR_ERR             (0xFFFF)
    214 #define AHCI_PX_SERR_DIAG        (0xFFFF0000)
    215 #define AHCI_PX_SERR_DIAG_X      (0x04000000)
    216 
    217 #define AHCI_PX_SACT                     (13)
    218 #define AHCI_PX_CI                       (14)
    219 #define AHCI_PX_SNTF                     (15)
    220 
    221 #define AHCI_PX_FBS                      (16)
    222 #define AHCI_PX_FBS_EN                  (0x1)
    223 #define AHCI_PX_FBS_DEC                 (0x2)
    224 #define AHCI_PX_FBS_SDE                 (0x4)
    225 #define AHCI_PX_FBS_DEV               (0xF00)
    226 #define AHCI_PX_FBS_ADO              (0xF000)
    227 #define AHCI_PX_FBS_DWE             (0xF0000)
    228 #define AHCI_PX_FBS_RESERVED     (0xFFF000F8)
    229 
    230 #define AHCI_PX_RES2                     (17)
    231 #define AHCI_PX_VS                       (28)
    232 
    233 #define HBA_DATA_REGION_SIZE            (256)
    234 #define HBA_PORT_DATA_SIZE              (128)
    235 #define HBA_PORT_NUM_REG (HBA_PORT_DATA_SIZE/4)
    236 
    237 #define AHCI_VERSION_0_95        (0x00000905)
    238 #define AHCI_VERSION_1_0         (0x00010000)
    239 #define AHCI_VERSION_1_1         (0x00010100)
    240 #define AHCI_VERSION_1_2         (0x00010200)
    241 #define AHCI_VERSION_1_3         (0x00010300)
    242 
    243 #define AHCI_SECTOR_SIZE                (512)
    244 #define ATAPI_SECTOR_SIZE              (2048)
    245 
    246 #define AHCI_SIGNATURE_CDROM     (0xeb140101)
    247 #define AHCI_SIGNATURE_DISK      (0x00000101)
    248 
    249 /* FIS types */
    250 enum {
    251     REG_H2D_FIS = 0x27,
    252     REG_D2H_FIS = 0x34,
    253     DMA_ACTIVATE_FIS = 0x39,
    254     DMA_SETUP_FIS = 0x41,
    255     DATA_FIS = 0x46,
    256     BIST_ACTIVATE_FIS = 0x58,
    257     PIO_SETUP_FIS = 0x5F,
    258     SDB_FIS = 0xA1
    259 };
    260 
    261 /* FIS flags */
    262 #define REG_H2D_FIS_CMD  0x80
    263 
    264 /* ATA Commands */
    265 enum {
    266     /* DMA */
    267     CMD_READ_DMA       = 0xC8,
    268     CMD_READ_DMA_EXT   = 0x25,
    269     CMD_WRITE_DMA      = 0xCA,
    270     CMD_WRITE_DMA_EXT  = 0x35,
    271     /* PIO */
    272     CMD_READ_PIO       = 0x20,
    273     CMD_READ_PIO_EXT   = 0x24,
    274     CMD_WRITE_PIO      = 0x30,
    275     CMD_WRITE_PIO_EXT  = 0x34,
    276     /* Misc */
    277     CMD_READ_MAX       = 0xF8,
    278     CMD_READ_MAX_EXT   = 0x27,
    279     CMD_FLUSH_CACHE    = 0xE7,
    280     CMD_IDENTIFY       = 0xEC,
    281     CMD_PACKET         = 0xA0,
    282     CMD_PACKET_ID      = 0xA1,
    283     /* NCQ */
    284     READ_FPDMA_QUEUED  = 0x60,
    285     WRITE_FPDMA_QUEUED = 0x61,
    286 };
    287 
    288 /* ATAPI Commands */
    289 enum {
    290     CMD_ATAPI_TEST_UNIT_READY = 0x00,
    291     CMD_ATAPI_REQUEST_SENSE   = 0x03,
    292     CMD_ATAPI_START_STOP_UNIT = 0x1b,
    293     CMD_ATAPI_READ_10         = 0x28,
    294     CMD_ATAPI_READ_CD         = 0xbe,
    295 };
    296 
    297 enum {
    298     SENSE_NO_SENSE       = 0x00,
    299     SENSE_NOT_READY      = 0x02,
    300     SENSE_UNIT_ATTENTION = 0x06,
    301 };
    302 
    303 enum {
    304     ASC_MEDIUM_MAY_HAVE_CHANGED = 0x28,
    305     ASC_MEDIUM_NOT_PRESENT      = 0x3a,
    306 };
    307 
    308 /* AHCI Command Header Flags & Masks*/
    309 #define CMDH_CFL        (0x1F)
    310 #define CMDH_ATAPI      (0x20)
    311 #define CMDH_WRITE      (0x40)
    312 #define CMDH_PREFETCH   (0x80)
    313 #define CMDH_RESET     (0x100)
    314 #define CMDH_BIST      (0x200)
    315 #define CMDH_CLR_BSY   (0x400)
    316 #define CMDH_RES       (0x800)
    317 #define CMDH_PMP      (0xF000)
    318 
    319 /* ATA device register masks */
    320 #define ATA_DEVICE_MAGIC 0xA0 /* used in ata1-3 */
    321 #define ATA_DEVICE_LBA   0x40
    322 #define NCQ_DEVICE_MAGIC 0x40 /* for ncq device registers */
    323 #define ATA_DEVICE_DRIVE 0x10
    324 #define ATA_DEVICE_HEAD  0x0F
    325 
    326 /*** Structures ***/
    327 
    328 typedef struct AHCIPortQState {
    329     uint64_t fb;
    330     uint64_t clb;
    331     uint64_t ctba[32];
    332     uint16_t prdtl[32];
    333     uint8_t next; /** Next Command Slot to Use **/
    334 } AHCIPortQState;
    335 
    336 typedef struct AHCIQState {
    337     QOSState *parent;
    338     QPCIDevice *dev;
    339     QPCIBar hba_bar;
    340     uint64_t barsize;
    341     uint32_t fingerprint;
    342     uint32_t cap;
    343     uint32_t cap2;
    344     AHCIPortQState port[32];
    345     bool enabled;
    346 } AHCIQState;
    347 
    348 /**
    349  * Generic FIS structure.
    350  */
    351 typedef struct FIS {
    352     uint8_t fis_type;
    353     uint8_t flags;
    354     char data[];
    355 } __attribute__((__packed__)) FIS;
    356 
    357 /**
    358  * Register device-to-host FIS structure.
    359  */
    360 typedef struct RegD2HFIS {
    361     /* DW0 */
    362     uint8_t fis_type;
    363     uint8_t flags;
    364     uint8_t status;
    365     uint8_t error;
    366     /* DW1 */
    367     uint8_t lba_lo[3];
    368     uint8_t device;
    369     /* DW2 */
    370     uint8_t lba_hi[3];
    371     uint8_t res0;
    372     /* DW3 */
    373     uint16_t count;
    374     uint16_t res1;
    375     /* DW4 */
    376     uint32_t res2;
    377 } __attribute__((__packed__)) RegD2HFIS;
    378 
    379 /**
    380  * Register device-to-host FIS structure;
    381  * PIO Setup variety.
    382  */
    383 typedef struct PIOSetupFIS {
    384     /* DW0 */
    385     uint8_t fis_type;
    386     uint8_t flags;
    387     uint8_t status;
    388     uint8_t error;
    389     /* DW1 */
    390     uint8_t lba_lo[3];
    391     uint8_t device;
    392     /* DW2 */
    393     uint8_t lba_hi[3];
    394     uint8_t res0;
    395     /* DW3 */
    396     uint16_t count;
    397     uint8_t res1;
    398     uint8_t e_status;
    399     /* DW4 */
    400     uint16_t tx_count;
    401     uint16_t res2;
    402 } __attribute__((__packed__)) PIOSetupFIS;
    403 
    404 /**
    405  * Register host-to-device FIS structure.
    406  */
    407 typedef struct RegH2DFIS {
    408     /* DW0 */
    409     uint8_t fis_type;
    410     uint8_t flags;
    411     uint8_t command;
    412     uint8_t feature_low;
    413     /* DW1 */
    414     uint8_t lba_lo[3];
    415     uint8_t device;
    416     /* DW2 */
    417     uint8_t lba_hi[3];
    418     uint8_t feature_high;
    419     /* DW3 */
    420     uint16_t count;
    421     uint8_t icc;
    422     uint8_t control;
    423     /* DW4 */
    424     uint8_t aux[4];
    425 } __attribute__((__packed__)) RegH2DFIS;
    426 
    427 /**
    428  * Register host-to-device FIS structure, for NCQ commands.
    429  * Actually just a RegH2DFIS, but with fields repurposed.
    430  * Repurposed fields are annotated below.
    431  */
    432 typedef struct NCQFIS {
    433     /* DW0 */
    434     uint8_t fis_type;
    435     uint8_t flags;
    436     uint8_t command;
    437     uint8_t sector_low; /* H2D: Feature 7:0 */
    438     /* DW1 */
    439     uint8_t lba_lo[3];
    440     uint8_t device;
    441     /* DW2 */
    442     uint8_t lba_hi[3];
    443     uint8_t sector_hi; /* H2D: Feature 15:8 */
    444     /* DW3 */
    445     uint8_t tag;       /* H2D: Count 0:7 */
    446     uint8_t prio;      /* H2D: Count 15:8 */
    447     uint8_t icc;
    448     uint8_t control;
    449     /* DW4 */
    450     uint8_t aux[4];
    451 } __attribute__((__packed__)) NCQFIS;
    452 
    453 /**
    454  * Command List entry structure.
    455  * The command list contains between 1-32 of these structures.
    456  */
    457 typedef struct AHCICommandHeader {
    458     uint16_t flags; /* Cmd-Fis-Len, PMP#, and flags. */
    459     uint16_t prdtl; /* Phys Region Desc. Table Length */
    460     uint32_t prdbc; /* Phys Region Desc. Byte Count */
    461     uint64_t ctba;  /* Command Table Descriptor Base Address */
    462     uint32_t res[4];
    463 } __attribute__((__packed__)) AHCICommandHeader;
    464 
    465 /**
    466  * Physical Region Descriptor; pointed to by the Command List Header,
    467  * struct ahci_command.
    468  */
    469 typedef struct PRD {
    470     uint64_t dba;  /* Data Base Address */
    471     uint32_t res;  /* Reserved */
    472     uint32_t dbc;  /* Data Byte Count (0-indexed) & Interrupt Flag (bit 2^31) */
    473 } __attribute__((__packed__)) PRD;
    474 
    475 /* Opaque, defined within ahci.c */
    476 typedef struct AHCICommand AHCICommand;
    477 
    478 /* Options to ahci_exec */
    479 typedef struct AHCIOpts {
    480     size_t size;        /* Size of transfer */
    481     unsigned prd_size;  /* Size per-each PRD */
    482     bool set_bcl;       /* Override the default BCL of ATAPI_SECTOR_SIZE */
    483     unsigned bcl;       /* Byte Count Limit, for ATAPI PIO */
    484     uint64_t lba;       /* Starting LBA offset */
    485     uint64_t buffer;    /* Pointer to source or destination guest buffer */
    486     bool atapi;         /* ATAPI command? */
    487     bool atapi_dma;     /* Use DMA for ATAPI? */
    488     bool error;
    489     int (*pre_cb)(AHCIQState*, AHCICommand*, const struct AHCIOpts *);
    490     int (*mid_cb)(AHCIQState*, AHCICommand*, const struct AHCIOpts *);
    491     int (*post_cb)(AHCIQState*, AHCICommand*, const struct AHCIOpts *);
    492     void *opaque;
    493 } AHCIOpts;
    494 
    495 /*** Macro Utilities ***/
    496 #define BITANY(data, mask) (((data) & (mask)) != 0)
    497 #define BITSET(data, mask) (((data) & (mask)) == (mask))
    498 #define BITCLR(data, mask) (((data) & (mask)) == 0)
    499 #define ASSERT_BIT_SET(data, mask) g_assert_cmphex((data) & (mask), ==, (mask))
    500 #define ASSERT_BIT_CLEAR(data, mask) g_assert_cmphex((data) & (mask), ==, 0)
    501 
    502 /* For calculating how big the PRD table needs to be: */
    503 #define CMD_TBL_SIZ(n) ((0x80 + ((n) * sizeof(PRD)) + 0x7F) & ~0x7F)
    504 
    505 /* Helpers for reading/writing AHCI HBA register values */
    506 
    507 static inline uint32_t ahci_mread(AHCIQState *ahci, size_t offset)
    508 {
    509     return qpci_io_readl(ahci->dev, ahci->hba_bar, offset);
    510 }
    511 
    512 static inline void ahci_mwrite(AHCIQState *ahci, size_t offset, uint32_t value)
    513 {
    514     qpci_io_writel(ahci->dev, ahci->hba_bar, offset, value);
    515 }
    516 
    517 static inline uint32_t ahci_rreg(AHCIQState *ahci, uint32_t reg_num)
    518 {
    519     return ahci_mread(ahci, 4 * reg_num);
    520 }
    521 
    522 static inline void ahci_wreg(AHCIQState *ahci, uint32_t reg_num, uint32_t value)
    523 {
    524     ahci_mwrite(ahci, 4 * reg_num, value);
    525 }
    526 
    527 static inline void ahci_set(AHCIQState *ahci, uint32_t reg_num, uint32_t mask)
    528 {
    529     ahci_wreg(ahci, reg_num, ahci_rreg(ahci, reg_num) | mask);
    530 }
    531 
    532 static inline void ahci_clr(AHCIQState *ahci, uint32_t reg_num, uint32_t mask)
    533 {
    534     ahci_wreg(ahci, reg_num, ahci_rreg(ahci, reg_num) & ~mask);
    535 }
    536 
    537 static inline size_t ahci_px_offset(uint8_t port, uint32_t reg_num)
    538 {
    539     return AHCI_PORTS + (HBA_PORT_NUM_REG * port) + reg_num;
    540 }
    541 
    542 static inline uint32_t ahci_px_rreg(AHCIQState *ahci, uint8_t port,
    543                                     uint32_t reg_num)
    544 {
    545     return ahci_rreg(ahci, ahci_px_offset(port, reg_num));
    546 }
    547 
    548 static inline void ahci_px_wreg(AHCIQState *ahci, uint8_t port,
    549                                 uint32_t reg_num, uint32_t value)
    550 {
    551     ahci_wreg(ahci, ahci_px_offset(port, reg_num), value);
    552 }
    553 
    554 static inline void ahci_px_set(AHCIQState *ahci, uint8_t port,
    555                                uint32_t reg_num, uint32_t mask)
    556 {
    557     ahci_px_wreg(ahci, port, reg_num,
    558                  ahci_px_rreg(ahci, port, reg_num) | mask);
    559 }
    560 
    561 static inline void ahci_px_clr(AHCIQState *ahci, uint8_t port,
    562                                uint32_t reg_num, uint32_t mask)
    563 {
    564     ahci_px_wreg(ahci, port, reg_num,
    565                  ahci_px_rreg(ahci, port, reg_num) & ~mask);
    566 }
    567 
    568 /*** Prototypes ***/
    569 uint64_t ahci_alloc(AHCIQState *ahci, size_t bytes);
    570 void ahci_free(AHCIQState *ahci, uint64_t addr);
    571 void ahci_clean_mem(AHCIQState *ahci);
    572 
    573 /* Device management */
    574 QPCIDevice *get_ahci_device(QTestState *qts, uint32_t *fingerprint);
    575 void free_ahci_device(QPCIDevice *dev);
    576 void ahci_pci_enable(AHCIQState *ahci);
    577 void start_ahci_device(AHCIQState *ahci);
    578 void ahci_hba_enable(AHCIQState *ahci);
    579 
    580 /* Port Management */
    581 unsigned ahci_port_select(AHCIQState *ahci);
    582 void ahci_port_clear(AHCIQState *ahci, uint8_t port);
    583 
    584 /* Command header / table management */
    585 unsigned ahci_pick_cmd(AHCIQState *ahci, uint8_t port);
    586 void ahci_get_command_header(AHCIQState *ahci, uint8_t port,
    587                              uint8_t slot, AHCICommandHeader *cmd);
    588 void ahci_set_command_header(AHCIQState *ahci, uint8_t port,
    589                              uint8_t slot, AHCICommandHeader *cmd);
    590 void ahci_destroy_command(AHCIQState *ahci, uint8_t port, uint8_t slot);
    591 
    592 /* AHCI sanity check routines */
    593 void ahci_port_check_error(AHCIQState *ahci, uint8_t port,
    594                            uint32_t imask, uint8_t emask);
    595 void ahci_port_check_interrupts(AHCIQState *ahci, uint8_t port,
    596                                 uint32_t intr_mask);
    597 void ahci_port_check_nonbusy(AHCIQState *ahci, uint8_t port, uint8_t slot);
    598 void ahci_port_check_d2h_sanity(AHCIQState *ahci, uint8_t port, uint8_t slot);
    599 void ahci_port_check_pio_sanity(AHCIQState *ahci, AHCICommand *cmd);
    600 void ahci_port_check_cmd_sanity(AHCIQState *ahci, AHCICommand *cmd);
    601 
    602 /* Misc */
    603 bool is_atapi(AHCIQState *ahci, uint8_t port);
    604 unsigned size_to_prdtl(unsigned bytes, unsigned bytes_per_prd);
    605 
    606 /* Command: Macro level execution */
    607 void ahci_guest_io(AHCIQState *ahci, uint8_t port, uint8_t ide_cmd,
    608                    uint64_t gbuffer, size_t size, uint64_t sector);
    609 AHCICommand *ahci_guest_io_halt(AHCIQState *ahci, uint8_t port, uint8_t ide_cmd,
    610                                 uint64_t gbuffer, size_t size, uint64_t sector);
    611 void ahci_guest_io_resume(AHCIQState *ahci, AHCICommand *cmd);
    612 void ahci_io(AHCIQState *ahci, uint8_t port, uint8_t ide_cmd,
    613              void *buffer, size_t bufsize, uint64_t sector);
    614 void ahci_exec(AHCIQState *ahci, uint8_t port,
    615                uint8_t op, const AHCIOpts *opts);
    616 void ahci_atapi_test_ready(AHCIQState *ahci, uint8_t port, bool ready,
    617                            uint8_t expected_sense);
    618 void ahci_atapi_get_sense(AHCIQState *ahci, uint8_t port,
    619                           uint8_t *sense, uint8_t *asc);
    620 void ahci_atapi_eject(AHCIQState *ahci, uint8_t port);
    621 void ahci_atapi_load(AHCIQState *ahci, uint8_t port);
    622 
    623 /* Command: Fine-grained lifecycle */
    624 AHCICommand *ahci_command_create(uint8_t command_name);
    625 AHCICommand *ahci_atapi_command_create(uint8_t scsi_cmd, uint16_t bcl, bool dma);
    626 void ahci_command_commit(AHCIQState *ahci, AHCICommand *cmd, uint8_t port);
    627 void ahci_command_issue(AHCIQState *ahci, AHCICommand *cmd);
    628 void ahci_command_issue_async(AHCIQState *ahci, AHCICommand *cmd);
    629 void ahci_command_wait(AHCIQState *ahci, AHCICommand *cmd);
    630 void ahci_command_verify(AHCIQState *ahci, AHCICommand *cmd);
    631 void ahci_command_free(AHCICommand *cmd);
    632 
    633 /* Command: adjustments */
    634 void ahci_command_set_flags(AHCICommand *cmd, uint16_t cmdh_flags);
    635 void ahci_command_clr_flags(AHCICommand *cmd, uint16_t cmdh_flags);
    636 void ahci_command_set_offset(AHCICommand *cmd, uint64_t lba_sect);
    637 void ahci_command_set_buffer(AHCICommand *cmd, uint64_t buffer);
    638 void ahci_command_set_size(AHCICommand *cmd, uint64_t xbytes);
    639 void ahci_command_set_prd_size(AHCICommand *cmd, unsigned prd_size);
    640 void ahci_command_set_sizes(AHCICommand *cmd, uint64_t xbytes,
    641                             unsigned prd_size);
    642 void ahci_command_set_acmd(AHCICommand *cmd, void *acmd);
    643 void ahci_command_enable_atapi_dma(AHCICommand *cmd);
    644 void ahci_command_adjust(AHCICommand *cmd, uint64_t lba_sect, uint64_t gbuffer,
    645                          uint64_t xbytes, unsigned prd_size);
    646 
    647 /* Command: Misc */
    648 uint8_t ahci_command_slot(AHCICommand *cmd);
    649 void ahci_write_fis(AHCIQState *ahci, AHCICommand *cmd);
    650 
    651 #endif