Home | History | Annotate | Line # | Download | only in pci
ahcisata_pci.c revision 1.11.4.3
      1  1.11.4.3      yamt /*	$NetBSD: ahcisata_pci.c,v 1.11.4.3 2009/09/16 13:37:50 yamt Exp $	*/
      2       1.1    bouyer 
      3       1.1    bouyer /*
      4       1.1    bouyer  * Copyright (c) 2006 Manuel Bouyer.
      5       1.1    bouyer  *
      6       1.1    bouyer  * Redistribution and use in source and binary forms, with or without
      7       1.1    bouyer  * modification, are permitted provided that the following conditions
      8       1.1    bouyer  * are met:
      9       1.1    bouyer  * 1. Redistributions of source code must retain the above copyright
     10       1.1    bouyer  *    notice, this list of conditions and the following disclaimer.
     11       1.1    bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     12       1.1    bouyer  *    notice, this list of conditions and the following disclaimer in the
     13       1.1    bouyer  *    documentation and/or other materials provided with the distribution.
     14       1.1    bouyer  * 3. All advertising materials mentioning features or use of this software
     15       1.1    bouyer  *    must display the following acknowledgement:
     16       1.1    bouyer  *	This product includes software developed by Manuel Bouyer.
     17       1.1    bouyer  * 4. The name of the author may not be used to endorse or promote products
     18       1.1    bouyer  *    derived from this software without specific prior written permission.
     19       1.1    bouyer  *
     20       1.1    bouyer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21       1.1    bouyer  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22       1.1    bouyer  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23       1.1    bouyer  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24       1.1    bouyer  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25       1.1    bouyer  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26       1.1    bouyer  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27       1.1    bouyer  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28       1.1    bouyer  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29       1.1    bouyer  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30       1.1    bouyer  *
     31       1.1    bouyer  */
     32       1.1    bouyer 
     33       1.1    bouyer #include <sys/cdefs.h>
     34  1.11.4.3      yamt __KERNEL_RCSID(0, "$NetBSD: ahcisata_pci.c,v 1.11.4.3 2009/09/16 13:37:50 yamt Exp $");
     35       1.1    bouyer 
     36       1.1    bouyer #include <sys/types.h>
     37       1.1    bouyer #include <sys/malloc.h>
     38       1.1    bouyer #include <sys/param.h>
     39       1.1    bouyer #include <sys/kernel.h>
     40       1.1    bouyer #include <sys/systm.h>
     41       1.1    bouyer #include <sys/disklabel.h>
     42       1.2  jmcneill #include <sys/pmf.h>
     43       1.1    bouyer 
     44       1.1    bouyer #include <uvm/uvm_extern.h>
     45       1.1    bouyer 
     46       1.1    bouyer #include <dev/pci/pcivar.h>
     47       1.1    bouyer #include <dev/pci/pcidevs.h>
     48       1.1    bouyer #include <dev/pci/pciidereg.h>
     49       1.1    bouyer #include <dev/pci/pciidevar.h>
     50       1.1    bouyer #include <dev/ic/ahcisatavar.h>
     51       1.1    bouyer 
     52  1.11.4.1      yamt #define AHCI_PCI_QUIRK_FORCE	1	/* force attach */
     53  1.11.4.1      yamt 
     54  1.11.4.1      yamt static const struct pci_quirkdata ahci_pci_quirks[] = {
     55  1.11.4.1      yamt 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA,
     56  1.11.4.1      yamt 	    AHCI_PCI_QUIRK_FORCE },
     57  1.11.4.1      yamt 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA2,
     58  1.11.4.1      yamt 	    AHCI_PCI_QUIRK_FORCE },
     59  1.11.4.1      yamt 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA3,
     60  1.11.4.1      yamt 	    AHCI_PCI_QUIRK_FORCE },
     61  1.11.4.1      yamt 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_SATA4,
     62  1.11.4.1      yamt 	    AHCI_PCI_QUIRK_FORCE },
     63  1.11.4.1      yamt 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_SATA,
     64  1.11.4.1      yamt 	    AHCI_PCI_QUIRK_FORCE },
     65  1.11.4.1      yamt 	{ PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP73_AHCI_1,
     66  1.11.4.1      yamt 	    AHCI_PCI_QUIRK_FORCE },
     67  1.11.4.2      yamt 	{ PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_88SE6121,
     68  1.11.4.2      yamt 	    AHCI_PCI_QUIRK_FORCE },
     69  1.11.4.1      yamt };
     70  1.11.4.1      yamt 
     71       1.2  jmcneill struct ahci_pci_softc {
     72       1.9      cube 	struct ahci_softc ah_sc;
     73       1.2  jmcneill 	pci_chipset_tag_t sc_pc;
     74       1.2  jmcneill 	pcitag_t sc_pcitag;
     75       1.2  jmcneill };
     76       1.2  jmcneill 
     77       1.2  jmcneill 
     78       1.9      cube static int  ahci_pci_match(device_t, cfdata_t, void *);
     79       1.9      cube static void ahci_pci_attach(device_t, device_t, void *);
     80  1.11.4.1      yamt const struct pci_quirkdata *ahci_pci_lookup_quirkdata(pci_vendor_id_t,
     81  1.11.4.1      yamt 						      pci_product_id_t);
     82       1.8    dyoung static bool ahci_pci_resume(device_t PMF_FN_PROTO);
     83       1.2  jmcneill 
     84       1.1    bouyer 
     85       1.9      cube CFATTACH_DECL_NEW(ahcisata_pci, sizeof(struct ahci_pci_softc),
     86       1.1    bouyer     ahci_pci_match, ahci_pci_attach, NULL, NULL);
     87       1.1    bouyer 
     88       1.1    bouyer static int
     89       1.9      cube ahci_pci_match(device_t parent, cfdata_t match, void *aux)
     90       1.1    bouyer {
     91       1.1    bouyer 	struct pci_attach_args *pa = aux;
     92       1.1    bouyer 	bus_space_tag_t regt;
     93       1.1    bouyer 	bus_space_handle_t regh;
     94       1.1    bouyer 	bus_size_t size;
     95       1.1    bouyer 	int ret = 0;
     96  1.11.4.1      yamt 	const struct pci_quirkdata *quirks;
     97  1.11.4.1      yamt 
     98  1.11.4.1      yamt 	quirks = ahci_pci_lookup_quirkdata(PCI_VENDOR(pa->pa_id),
     99  1.11.4.1      yamt 					   PCI_PRODUCT(pa->pa_id));
    100       1.1    bouyer 
    101  1.11.4.1      yamt 	/* if wrong class and not forced by quirks, don't match */
    102  1.11.4.1      yamt 	if ((PCI_CLASS(pa->pa_class) != PCI_CLASS_MASS_STORAGE ||
    103  1.11.4.1      yamt 	    ((PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_MASS_STORAGE_SATA ||
    104  1.11.4.1      yamt 	     PCI_INTERFACE(pa->pa_class) != PCI_INTERFACE_SATA_AHCI) &&
    105  1.11.4.1      yamt 	     PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_MASS_STORAGE_RAID)) &&
    106  1.11.4.1      yamt 	    (quirks == NULL || (quirks->quirks & AHCI_PCI_QUIRK_FORCE) == 0))
    107  1.11.4.1      yamt 		return 0;
    108  1.11.4.1      yamt 
    109  1.11.4.1      yamt 	if (pci_mapreg_map(pa, AHCI_PCI_ABAR,
    110  1.11.4.1      yamt 	    PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT, 0,
    111  1.11.4.1      yamt 	    &regt, &regh, NULL, &size) != 0)
    112  1.11.4.1      yamt 		return 0;
    113  1.11.4.1      yamt 
    114  1.11.4.1      yamt 	if ((PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_MASS_STORAGE_SATA &&
    115       1.3   xtraeme 	     PCI_INTERFACE(pa->pa_class) == PCI_INTERFACE_SATA_AHCI) ||
    116  1.11.4.1      yamt 	    (quirks && quirks->quirks & AHCI_PCI_QUIRK_FORCE) ||
    117  1.11.4.1      yamt 	    (bus_space_read_4(regt, regh, AHCI_GHC) & AHCI_GHC_AE))
    118  1.11.4.1      yamt 		ret = 3;
    119       1.1    bouyer 
    120  1.11.4.1      yamt 	bus_space_unmap(regt, regh, size);
    121       1.5   jnemeth 	return ret;
    122       1.1    bouyer }
    123       1.1    bouyer 
    124       1.1    bouyer static void
    125       1.9      cube ahci_pci_attach(device_t parent, device_t self, void *aux)
    126       1.1    bouyer {
    127       1.1    bouyer 	struct pci_attach_args *pa = aux;
    128       1.9      cube 	struct ahci_pci_softc *psc = device_private(self);
    129       1.2  jmcneill 	struct ahci_softc *sc = &psc->ah_sc;
    130       1.1    bouyer 	bus_size_t size;
    131       1.1    bouyer 	char devinfo[256];
    132       1.1    bouyer 	const char *intrstr;
    133       1.1    bouyer 	pci_intr_handle_t intrhandle;
    134       1.1    bouyer 	void *ih;
    135       1.1    bouyer 
    136      1.11      cube 	sc->sc_atac.atac_dev = self;
    137      1.10      cube 
    138       1.1    bouyer 	if (pci_mapreg_map(pa, AHCI_PCI_ABAR,
    139       1.1    bouyer 	    PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT, 0,
    140       1.1    bouyer 	    &sc->sc_ahcit, &sc->sc_ahcih, NULL, &size) != 0) {
    141       1.9      cube 		aprint_error_dev(self, "can't map ahci registers\n");
    142       1.1    bouyer 		return;
    143       1.1    bouyer 	}
    144       1.2  jmcneill 	psc->sc_pc = pa->pa_pc;
    145       1.2  jmcneill 	psc->sc_pcitag = pa->pa_tag;
    146       1.2  jmcneill 
    147       1.1    bouyer 	pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
    148       1.1    bouyer 	aprint_naive(": AHCI disk controller\n");
    149       1.1    bouyer 	aprint_normal(": %s\n", devinfo);
    150       1.1    bouyer 
    151       1.1    bouyer 	if (pci_intr_map(pa, &intrhandle) != 0) {
    152       1.1    bouyer 		aprint_error("%s: couldn't map interrupt\n", AHCINAME(sc));
    153       1.1    bouyer 		return;
    154       1.1    bouyer 	}
    155       1.1    bouyer 	intrstr = pci_intr_string(pa->pa_pc, intrhandle);
    156       1.1    bouyer 	ih = pci_intr_establish(pa->pa_pc, intrhandle, IPL_BIO, ahci_intr, sc);
    157       1.1    bouyer 	if (ih == NULL) {
    158       1.1    bouyer 		aprint_error("%s: couldn't establish interrupt", AHCINAME(sc));
    159       1.1    bouyer 		return;
    160       1.1    bouyer 	}
    161       1.1    bouyer 	aprint_normal("%s: interrupting at %s\n", AHCINAME(sc),
    162       1.1    bouyer 	    intrstr ? intrstr : "unknown interrupt");
    163       1.1    bouyer 	sc->sc_dmat = pa->pa_dmat;
    164       1.3   xtraeme 
    165       1.6   mlelstv 	if (PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_MASS_STORAGE_RAID) {
    166       1.7   mlelstv 		AHCIDEBUG_PRINT(("%s: RAID mode\n", AHCINAME(sc)), DEBUG_PROBE);
    167       1.3   xtraeme 		sc->sc_atac_capflags = ATAC_CAP_RAID;
    168       1.6   mlelstv 	} else {
    169       1.7   mlelstv 		AHCIDEBUG_PRINT(("%s: SATA mode\n", AHCINAME(sc)), DEBUG_PROBE);
    170       1.6   mlelstv 	}
    171       1.3   xtraeme 
    172       1.1    bouyer 	ahci_attach(sc);
    173       1.2  jmcneill 
    174       1.2  jmcneill 	if (!pmf_device_register(self, NULL, ahci_pci_resume))
    175       1.2  jmcneill 		aprint_error_dev(self, "couldn't establish power handler\n");
    176       1.2  jmcneill }
    177       1.2  jmcneill 
    178       1.2  jmcneill static bool
    179       1.8    dyoung ahci_pci_resume(device_t dv PMF_FN_ARGS)
    180       1.2  jmcneill {
    181       1.2  jmcneill 	struct ahci_pci_softc *psc = device_private(dv);
    182       1.2  jmcneill 	struct ahci_softc *sc = &psc->ah_sc;
    183       1.2  jmcneill 	int s;
    184       1.2  jmcneill 
    185       1.2  jmcneill 	s = splbio();
    186       1.2  jmcneill 	ahci_reset(sc);
    187       1.2  jmcneill 	ahci_setup_ports(sc);
    188       1.2  jmcneill 	ahci_reprobe_drives(sc);
    189       1.2  jmcneill 	ahci_enable_intrs(sc);
    190       1.2  jmcneill 	splx(s);
    191       1.2  jmcneill 
    192       1.2  jmcneill 	return true;
    193       1.1    bouyer }
    194  1.11.4.1      yamt 
    195  1.11.4.1      yamt const struct pci_quirkdata *
    196  1.11.4.1      yamt ahci_pci_lookup_quirkdata(pci_vendor_id_t vendor, pci_product_id_t product)
    197  1.11.4.1      yamt {
    198  1.11.4.1      yamt 	int i;
    199  1.11.4.1      yamt 
    200  1.11.4.3      yamt 	for (i = 0; i < __arraycount(ahci_pci_quirks); i++)
    201  1.11.4.1      yamt 		if (vendor == ahci_pci_quirks[i].vendor &&
    202  1.11.4.1      yamt 		    product == ahci_pci_quirks[i].product)
    203  1.11.4.1      yamt 			return (&ahci_pci_quirks[i]);
    204  1.11.4.1      yamt 	return (NULL);
    205  1.11.4.1      yamt }
    206