Home | History | Annotate | Line # | Download | only in pci
ahcisata_pci.c revision 1.57
      1 /*	$NetBSD: ahcisata_pci.c,v 1.57 2020/01/18 11:26:11 simonb Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2006 Manuel Bouyer.
      5  *
      6  * Redistribution and use in source and binary forms, with or without
      7  * modification, are permitted provided that the following conditions
      8  * are met:
      9  * 1. Redistributions of source code must retain the above copyright
     10  *    notice, this list of conditions and the following disclaimer.
     11  * 2. Redistributions in binary form must reproduce the above copyright
     12  *    notice, this list of conditions and the following disclaimer in the
     13  *    documentation and/or other materials provided with the distribution.
     14  *
     15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     25  *
     26  */
     27 
     28 #include <sys/cdefs.h>
     29 __KERNEL_RCSID(0, "$NetBSD: ahcisata_pci.c,v 1.57 2020/01/18 11:26:11 simonb Exp $");
     30 
     31 #ifdef _KERNEL_OPT
     32 #include "opt_ahcisata_pci.h"
     33 #endif
     34 
     35 #ifdef _KERNEL_OPT
     36 #include "opt_ahcisata_pci.h"
     37 #endif
     38 
     39 #include <sys/types.h>
     40 #include <sys/kmem.h>
     41 #include <sys/param.h>
     42 #include <sys/kernel.h>
     43 #include <sys/systm.h>
     44 #include <sys/disklabel.h>
     45 #include <sys/pmf.h>
     46 
     47 #include <dev/pci/pcivar.h>
     48 #include <dev/pci/pcidevs.h>
     49 #include <dev/pci/pciidereg.h>
     50 #include <dev/pci/pciidevar.h>
     51 #include <dev/ic/ahcisatavar.h>
     52 
     53 struct ahci_pci_quirk {
     54 	pci_vendor_id_t  vendor;	/* Vendor ID */
     55 	pci_product_id_t product;	/* Product ID */
     56 	int              quirks;	/* quirks; same as sc_ahci_quirks */
     57 };
     58 
     59 static const struct ahci_pci_quirk ahci_pci_quirks[] = {
     60 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA,
     61 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
     62 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA2,
     63 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
     64 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA3,
     65 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
     66 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA4,
     67 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
     68 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_AHCI_1,
     69 	    AHCI_QUIRK_BADPMP },
     70 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_AHCI_2,
     71 	    AHCI_QUIRK_BADPMP },
     72 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_AHCI_3,
     73 	    AHCI_QUIRK_BADPMP },
     74 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_AHCI_4,
     75 	    AHCI_QUIRK_BADPMP },
     76 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_SATA,
     77 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
     78 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_SATA2,
     79 	    AHCI_QUIRK_BADPMP },
     80 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_SATA3,
     81 	    AHCI_QUIRK_BADPMP },
     82 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_SATA4,
     83 	     AHCI_QUIRK_BADPMP },
     84 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_1,
     85 	     AHCI_QUIRK_BADPMP },
     86 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_2,
     87 	     AHCI_QUIRK_BADPMP },
     88 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_3,
     89 	     AHCI_QUIRK_BADPMP },
     90 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_4,
     91 	     AHCI_QUIRK_BADPMP },
     92 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_5,
     93 	     AHCI_QUIRK_BADPMP },
     94 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_6,
     95 	     AHCI_QUIRK_BADPMP },
     96 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_7,
     97 	     AHCI_QUIRK_BADPMP },
     98 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_AHCI_8,
     99 	     AHCI_QUIRK_BADPMP },
    100 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_1,
    101 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    102 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_2,
    103 	    AHCI_QUIRK_BADPMP },
    104 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_3,
    105 	    AHCI_QUIRK_BADPMP },
    106 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_4,
    107 	    AHCI_QUIRK_BADPMP },
    108 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_5,
    109 	    AHCI_QUIRK_BADPMP },
    110 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_6,
    111 	    AHCI_QUIRK_BADPMP },
    112 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_7,
    113 	    AHCI_QUIRK_BADPMP },
    114 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_8,
    115 	    AHCI_QUIRK_BADPMP },
    116 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_9,
    117 	    AHCI_QUIRK_BADPMP },
    118 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_10,
    119 	    AHCI_QUIRK_BADPMP },
    120 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_11,
    121 	    AHCI_QUIRK_BADPMP },
    122 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_12,
    123 	    AHCI_QUIRK_BADPMP },
    124 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_1,
    125 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    126 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_2,
    127 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    128 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_3,
    129 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    130 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_4,
    131 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    132 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_5,
    133 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    134 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_6,
    135 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    136 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_7,
    137 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    138 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_8,
    139 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    140 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_9,
    141 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    142 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_10,
    143 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    144 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_11,
    145 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    146 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP77_AHCI_12,
    147 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    148 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_1,
    149 	    AHCI_QUIRK_BADPMP },
    150 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_2,
    151 	    AHCI_QUIRK_BADPMP },
    152 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_3,
    153 	    AHCI_QUIRK_BADPMP },
    154 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_4,
    155 	    AHCI_QUIRK_BADPMP },
    156 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_5,
    157 	    AHCI_QUIRK_BADPMP },
    158 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_6,
    159 	    AHCI_QUIRK_BADPMP },
    160 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_7,
    161 	    AHCI_QUIRK_BADPMP },
    162 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_8,
    163 	    AHCI_QUIRK_BADPMP },
    164 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_9,
    165 	    AHCI_QUIRK_BADPMP },
    166 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_10,
    167 	    AHCI_QUIRK_BADPMP },
    168 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_11,
    169 	    AHCI_QUIRK_BADPMP },
    170 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP79_AHCI_12,
    171 	    AHCI_QUIRK_BADPMP },
    172 	{ PCI_VENDOR_ALI, PCI_PRODUCT_ALI_M5288,
    173 	    AHCI_PCI_QUIRK_FORCE },
    174 	{ PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_88SE6121,
    175 	    AHCI_PCI_QUIRK_FORCE | AHCI_QUIRK_BADPMP },
    176 	{ PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_88SE6145,
    177 	    AHCI_QUIRK_BADPMP },
    178 	{ PCI_VENDOR_MARVELL2, PCI_PRODUCT_MARVELL2_88SE91XX,
    179 	    AHCI_PCI_QUIRK_FORCE },
    180 	/* ATI SB600 AHCI 64-bit DMA only works on some boards/BIOSes */
    181 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB600_SATA_1,
    182 	    AHCI_PCI_QUIRK_BAD64 | AHCI_QUIRK_BADPMP | AHCI_QUIRK_BADNCQ },
    183 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB700_SATA_AHCI,
    184 	    AHCI_QUIRK_BADPMP | AHCI_QUIRK_BADNCQ },
    185 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB700_SATA_RAID,
    186 	    AHCI_QUIRK_BADPMP | AHCI_QUIRK_BADNCQ },
    187 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB700_SATA_RAID5,
    188 	    AHCI_QUIRK_BADPMP | AHCI_QUIRK_BADNCQ },
    189 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB700_SATA_AHCI2,
    190 	    AHCI_QUIRK_BADPMP | AHCI_QUIRK_BADNCQ },
    191 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB700_SATA_STORAGE,
    192 	    AHCI_QUIRK_BADPMP | AHCI_QUIRK_BADNCQ },
    193 	{ PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT8237R_SATA,
    194 	    AHCI_QUIRK_BADPMP },
    195 	{ PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT8251_SATA,
    196 	    AHCI_QUIRK_BADPMP },
    197 	{ PCI_VENDOR_ASMEDIA, PCI_PRODUCT_ASMEDIA_ASM1061_01,
    198 	    AHCI_PCI_QUIRK_FORCE },
    199 	{ PCI_VENDOR_ASMEDIA, PCI_PRODUCT_ASMEDIA_ASM1061_02,
    200 	    AHCI_PCI_QUIRK_FORCE },
    201 	{ PCI_VENDOR_ASMEDIA, PCI_PRODUCT_ASMEDIA_ASM1061_11,
    202 	    AHCI_PCI_QUIRK_FORCE },
    203 	{ PCI_VENDOR_ASMEDIA, PCI_PRODUCT_ASMEDIA_ASM1061_12,
    204 	    AHCI_PCI_QUIRK_FORCE },
    205 	{ PCI_VENDOR_AMD, PCI_PRODUCT_AMD_HUDSON_SATA,
    206 	    AHCI_PCI_QUIRK_FORCE },
    207 	{ PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82801JI_SATA_AHCI,
    208 	    AHCI_QUIRK_BADPMP },
    209 	{ PCI_VENDOR_AMD, PCI_PRODUCT_AMD_HUDSON_SATA_AHCI,
    210 	    AHCI_QUIRK_BADPMP },
    211 };
    212 
    213 struct ahci_pci_softc {
    214 	struct ahci_softc ah_sc;
    215 	pci_chipset_tag_t sc_pc;
    216 	pcitag_t sc_pcitag;
    217 	pci_intr_handle_t *sc_pihp;
    218 	int sc_nintr;
    219 	void **sc_ih;
    220 };
    221 
    222 static int  ahci_pci_has_quirk(pci_vendor_id_t, pci_product_id_t);
    223 static int  ahci_pci_match(device_t, cfdata_t, void *);
    224 static void ahci_pci_attach(device_t, device_t, void *);
    225 static int  ahci_pci_detach(device_t, int);
    226 static void ahci_pci_childdetached(device_t, device_t);
    227 static bool ahci_pci_resume(device_t, const pmf_qual_t *);
    228 
    229 
    230 CFATTACH_DECL3_NEW(ahcisata_pci, sizeof(struct ahci_pci_softc),
    231     ahci_pci_match, ahci_pci_attach, ahci_pci_detach, NULL,
    232     NULL, ahci_pci_childdetached, DVF_DETACH_SHUTDOWN);
    233 
    234 #define	AHCI_PCI_ABAR_CAVIUM	0x10
    235 
    236 static int
    237 ahci_pci_has_quirk(pci_vendor_id_t vendor, pci_product_id_t product)
    238 {
    239 	int i;
    240 
    241 	for (i = 0; i < __arraycount(ahci_pci_quirks); i++)
    242 		if (vendor == ahci_pci_quirks[i].vendor &&
    243 		    product == ahci_pci_quirks[i].product)
    244 			return ahci_pci_quirks[i].quirks;
    245 	return 0;
    246 }
    247 
    248 static int
    249 ahci_pci_abar(struct pci_attach_args *pa)
    250 {
    251 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_CAVIUM) {
    252 		if (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_CAVIUM_THUNDERX_AHCI ||
    253 		    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_CAVIUM_THUNDERX_RAID) {
    254 			return AHCI_PCI_ABAR_CAVIUM;
    255 		}
    256 	}
    257 
    258 	return AHCI_PCI_ABAR;
    259 }
    260 
    261 
    262 static int
    263 ahci_pci_match(device_t parent, cfdata_t match, void *aux)
    264 {
    265 	struct pci_attach_args *pa = aux;
    266 	bus_space_tag_t regt;
    267 	bus_space_handle_t regh;
    268 	bus_size_t size;
    269 	int ret = 0;
    270 	bool force;
    271 
    272 	force = ((ahci_pci_has_quirk( PCI_VENDOR(pa->pa_id),
    273 	    PCI_PRODUCT(pa->pa_id)) & AHCI_PCI_QUIRK_FORCE) != 0);
    274 
    275 	/* if wrong class and not forced by quirks, don't match */
    276 	if ((PCI_CLASS(pa->pa_class) != PCI_CLASS_MASS_STORAGE ||
    277 	    ((PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_MASS_STORAGE_SATA ||
    278 	     PCI_INTERFACE(pa->pa_class) != PCI_INTERFACE_SATA_AHCI) &&
    279 	     PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_MASS_STORAGE_RAID)) &&
    280 	    (force == false))
    281 		return 0;
    282 
    283 	int bar = ahci_pci_abar(pa);
    284 	pcireg_t memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, bar);
    285 	if (pci_mapreg_map(pa, bar, memtype, 0, &regt, &regh, NULL, &size) != 0)
    286 		return 0;
    287 
    288 	if ((PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_MASS_STORAGE_SATA &&
    289 	     PCI_INTERFACE(pa->pa_class) == PCI_INTERFACE_SATA_AHCI) ||
    290 	    (bus_space_read_4(regt, regh, AHCI_GHC) & AHCI_GHC_AE) ||
    291 	    (force == true))
    292 		ret = 3;
    293 
    294 	bus_space_unmap(regt, regh, size);
    295 	return ret;
    296 }
    297 
    298 static int
    299 ahci_pci_intr_establish(struct ahci_softc *sc, int port)
    300 {
    301 	struct ahci_pci_softc *psc = (struct ahci_pci_softc *)sc;
    302 	device_t self = sc->sc_atac.atac_dev;
    303 	char intrbuf[PCI_INTRSTR_LEN];
    304 	char intr_xname[INTRDEVNAMEBUF];
    305 	const char *intrstr;
    306 	int vec;
    307 	int (*intr_handler)(void *);
    308 	void *intr_arg;
    309 
    310 	KASSERT(psc->sc_pihp != NULL);
    311 	KASSERT(psc->sc_nintr > 0);
    312 
    313 	snprintf(intr_xname, sizeof(intr_xname), "%s", device_xname(self));
    314 
    315 	if (psc->sc_nintr == 1 || sc->sc_ghc_mrsm) {
    316 		/* Only one interrupt, established on vector 0 */
    317 		intr_handler = ahci_intr;
    318 		intr_arg = sc;
    319 		vec = 0;
    320 
    321 		if (psc->sc_ih[vec] != NULL) {
    322 			/* Already established, nothing more to do */
    323 			goto out;
    324 		}
    325 
    326 	} else {
    327 		/*
    328 		 * Theoretically AHCI device can have less MSI/MSI-X vectors
    329 		 * than supported ports. Hardware is allowed to revert
    330 		 * to single message MSI, but not required to do so.
    331 		 * So handle the case when it did not revert to single MSI.
    332 		 * In this case last available interrupt vector is used
    333 		 * for port == max vector, and all further ports.
    334 		 * This last vector must use the general interrupt handler,
    335 		 * since it needs to be able to handle several ports.
    336 		 * NOTE: such case was never actually observed yet
    337 		 */
    338 		if (sc->sc_atac.atac_nchannels > psc->sc_nintr
    339 		    && port >= (psc->sc_nintr - 1)) {
    340 			intr_handler = ahci_intr;
    341 			intr_arg = sc;
    342 			vec = psc->sc_nintr - 1;
    343 
    344 			if (psc->sc_ih[vec] != NULL) {
    345 				/* Already established, nothing more to do */
    346 				goto out;
    347 			}
    348 
    349 			if (port == vec) {
    350 				/* Print error once */
    351 				aprint_error_dev(self,
    352 				    "port %d independant interrupt vector not "
    353 				    "available, sharing with further ports",
    354 				    port);
    355 			}
    356 		} else {
    357 			/* Vector according to port */
    358 			KASSERT(port < psc->sc_nintr);
    359 			KASSERT(psc->sc_ih[port] == NULL);
    360 			intr_handler = ahci_intr_port;
    361 			intr_arg = &sc->sc_channels[port];
    362 			vec = port;
    363 
    364 			snprintf(intr_xname, sizeof(intr_xname), "%s port%d",
    365 			    device_xname(self), port);
    366 		}
    367 	}
    368 
    369 	intrstr = pci_intr_string(psc->sc_pc, psc->sc_pihp[vec], intrbuf,
    370 	    sizeof(intrbuf));
    371 	psc->sc_ih[vec] = pci_intr_establish_xname(psc->sc_pc,
    372 	    psc->sc_pihp[vec], IPL_BIO, intr_handler, intr_arg, intr_xname);
    373 	if (psc->sc_ih == NULL) {
    374 		aprint_error_dev(self, "couldn't establish interrupt");
    375 		if (intrstr != NULL)
    376 			aprint_error(" at %s", intrstr);
    377 		aprint_error("\n");
    378 		goto fail;
    379 	}
    380 	aprint_normal_dev(self, "interrupting at %s\n", intrstr);
    381 
    382 out:
    383 	return 0;
    384 
    385 fail:
    386 	return EAGAIN;
    387 }
    388 
    389 static void
    390 ahci_pci_attach(device_t parent, device_t self, void *aux)
    391 {
    392 	struct pci_attach_args *pa = aux;
    393 	struct ahci_pci_softc *psc = device_private(self);
    394 	struct ahci_softc *sc = &psc->ah_sc;
    395 	bool ahci_cap_64bit;
    396 	bool ahci_bad_64bit;
    397 	pcireg_t reg;
    398 
    399 	sc->sc_atac.atac_dev = self;
    400 
    401 	int bar = ahci_pci_abar(pa);
    402 	pcireg_t memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, bar);
    403 	if (pci_mapreg_map(pa, bar, memtype, 0, &sc->sc_ahcit, &sc->sc_ahcih,
    404 	    NULL, &sc->sc_ahcis) != 0) {
    405 		aprint_error_dev(self, "can't map ahci registers\n");
    406 		return;
    407 	}
    408 	psc->sc_pc = pa->pa_pc;
    409 	psc->sc_pcitag = pa->pa_tag;
    410 
    411 	pci_aprint_devinfo(pa, "AHCI disk controller");
    412 
    413 	int counts[PCI_INTR_TYPE_SIZE] = {
    414 		[PCI_INTR_TYPE_INTX] = 1,
    415 		[PCI_INTR_TYPE_MSI] = 1,
    416 		[PCI_INTR_TYPE_MSIX] = -1,
    417 	};
    418 
    419 	/* Allocate and establish the interrupt. */
    420 	if (pci_intr_alloc(pa, &psc->sc_pihp, counts, PCI_INTR_TYPE_MSIX)) {
    421 		aprint_error_dev(self, "can't allocate handler\n");
    422 		goto fail;
    423 	}
    424 
    425 	psc->sc_nintr = counts[pci_intr_type(pa->pa_pc, psc->sc_pihp[0])];
    426 	psc->sc_ih = kmem_zalloc(sizeof(void *) * psc->sc_nintr, KM_SLEEP);
    427 	sc->sc_intr_establish = ahci_pci_intr_establish;
    428 
    429 	sc->sc_dmat = pa->pa_dmat;
    430 
    431 	sc->sc_ahci_quirks = ahci_pci_has_quirk(PCI_VENDOR(pa->pa_id),
    432 					    PCI_PRODUCT(pa->pa_id));
    433 
    434 	ahci_cap_64bit = (AHCI_READ(sc, AHCI_CAP) & AHCI_CAP_64BIT) != 0;
    435 	ahci_bad_64bit = ((sc->sc_ahci_quirks & AHCI_PCI_QUIRK_BAD64) != 0);
    436 
    437 	if (pci_dma64_available(pa) && ahci_cap_64bit) {
    438 		if (!ahci_bad_64bit)
    439 			sc->sc_dmat = pa->pa_dmat64;
    440 		aprint_verbose_dev(self, "64-bit DMA%s\n",
    441 		    (sc->sc_dmat == pa->pa_dmat) ? " unavailable" : "");
    442 	}
    443 
    444 	if (PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_MASS_STORAGE_RAID) {
    445 		AHCIDEBUG_PRINT(("%s: RAID mode\n", AHCINAME(sc)), DEBUG_PROBE);
    446 		sc->sc_atac_capflags = ATAC_CAP_RAID;
    447 	} else {
    448 		AHCIDEBUG_PRINT(("%s: SATA mode\n", AHCINAME(sc)), DEBUG_PROBE);
    449 	}
    450 
    451 	reg = pci_conf_read(psc->sc_pc, psc->sc_pcitag, PCI_COMMAND_STATUS_REG);
    452 	reg |= (PCI_COMMAND_MEM_ENABLE | PCI_COMMAND_MASTER_ENABLE);
    453 	pci_conf_write(psc->sc_pc, psc->sc_pcitag, PCI_COMMAND_STATUS_REG, reg);
    454 
    455 	ahci_attach(sc);
    456 
    457 	if (!pmf_device_register(self, NULL, ahci_pci_resume))
    458 		aprint_error_dev(self, "couldn't establish power handler\n");
    459 
    460 	return;
    461 fail:
    462 	if (psc->sc_pihp != NULL) {
    463 		pci_intr_release(psc->sc_pc, psc->sc_pihp, psc->sc_nintr);
    464 		psc->sc_pihp = NULL;
    465 	}
    466 	if (sc->sc_ahcis) {
    467 		bus_space_unmap(sc->sc_ahcit, sc->sc_ahcih, sc->sc_ahcis);
    468 		sc->sc_ahcis = 0;
    469 	}
    470 
    471 	return;
    472 
    473 }
    474 
    475 static void
    476 ahci_pci_childdetached(device_t dv, device_t child)
    477 {
    478 	struct ahci_pci_softc *psc = device_private(dv);
    479 	struct ahci_softc *sc = &psc->ah_sc;
    480 
    481 	ahci_childdetached(sc, child);
    482 }
    483 
    484 static int
    485 ahci_pci_detach(device_t dv, int flags)
    486 {
    487 	struct ahci_pci_softc *psc;
    488 	struct ahci_softc *sc;
    489 	int rv;
    490 
    491 	psc = device_private(dv);
    492 	sc = &psc->ah_sc;
    493 
    494 	if ((rv = ahci_detach(sc, flags)))
    495 		return rv;
    496 
    497 	pmf_device_deregister(dv);
    498 
    499 	if (psc->sc_ih != NULL) {
    500 		for (int intr = 0; intr < psc->sc_nintr; intr++) {
    501 			if (psc->sc_ih[intr] != NULL) {
    502 				pci_intr_disestablish(psc->sc_pc,
    503 				    psc->sc_ih[intr]);
    504 				psc->sc_ih[intr] = NULL;
    505 			}
    506 		}
    507 
    508 		kmem_free(psc->sc_ih, sizeof(void *) * psc->sc_nintr);
    509 		psc->sc_ih = NULL;
    510 	}
    511 
    512 	if (psc->sc_pihp != NULL) {
    513 		pci_intr_release(psc->sc_pc, psc->sc_pihp, psc->sc_nintr);
    514 		psc->sc_pihp = NULL;
    515 	}
    516 
    517 	bus_space_unmap(sc->sc_ahcit, sc->sc_ahcih, sc->sc_ahcis);
    518 
    519 	return 0;
    520 }
    521 
    522 static bool
    523 ahci_pci_resume(device_t dv, const pmf_qual_t *qual)
    524 {
    525 	struct ahci_pci_softc *psc = device_private(dv);
    526 	struct ahci_softc *sc = &psc->ah_sc;
    527 	int s;
    528 
    529 	s = splbio();
    530 	ahci_resume(sc);
    531 	splx(s);
    532 
    533 	return true;
    534 }
    535