1d3c7b9a0SKenneth D. Merry /*- 2d3c7b9a0SKenneth D. Merry * Copyright (c) 2009 Yahoo! Inc. 3d3c7b9a0SKenneth D. Merry * All rights reserved. 4d3c7b9a0SKenneth D. Merry * 5d3c7b9a0SKenneth D. Merry * Redistribution and use in source and binary forms, with or without 6d3c7b9a0SKenneth D. Merry * modification, are permitted provided that the following conditions 7d3c7b9a0SKenneth D. Merry * are met: 8d3c7b9a0SKenneth D. Merry * 1. Redistributions of source code must retain the above copyright 9d3c7b9a0SKenneth D. Merry * notice, this list of conditions and the following disclaimer. 10d3c7b9a0SKenneth D. Merry * 2. Redistributions in binary form must reproduce the above copyright 11d3c7b9a0SKenneth D. Merry * notice, this list of conditions and the following disclaimer in the 12d3c7b9a0SKenneth D. Merry * documentation and/or other materials provided with the distribution. 13d3c7b9a0SKenneth D. Merry * 14d3c7b9a0SKenneth D. Merry * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15d3c7b9a0SKenneth D. Merry * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16d3c7b9a0SKenneth D. Merry * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17d3c7b9a0SKenneth D. Merry * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18d3c7b9a0SKenneth D. Merry * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19d3c7b9a0SKenneth D. Merry * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20d3c7b9a0SKenneth D. Merry * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21d3c7b9a0SKenneth D. Merry * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22d3c7b9a0SKenneth D. Merry * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23d3c7b9a0SKenneth D. Merry * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24d3c7b9a0SKenneth D. Merry * SUCH DAMAGE. 25d3c7b9a0SKenneth D. Merry */ 26d3c7b9a0SKenneth D. Merry 27d3c7b9a0SKenneth D. Merry #include <sys/cdefs.h> 28d3c7b9a0SKenneth D. Merry __FBSDID("$FreeBSD$"); 29d3c7b9a0SKenneth D. Merry 30ef065d89SStephen McConnell /* PCI/PCI-X/PCIe bus interface for the Avago Tech (LSI) MPT2 controllers */ 31d3c7b9a0SKenneth D. Merry 32d043c564SKenneth D. Merry /* TODO Move headers to mpsvar */ 33d3c7b9a0SKenneth D. Merry #include <sys/types.h> 34d3c7b9a0SKenneth D. Merry #include <sys/param.h> 35d3c7b9a0SKenneth D. Merry #include <sys/systm.h> 36d3c7b9a0SKenneth D. Merry #include <sys/kernel.h> 37d3c7b9a0SKenneth D. Merry #include <sys/module.h> 38d3c7b9a0SKenneth D. Merry #include <sys/bus.h> 39d3c7b9a0SKenneth D. Merry #include <sys/conf.h> 40d3c7b9a0SKenneth D. Merry #include <sys/malloc.h> 41d3c7b9a0SKenneth D. Merry #include <sys/sysctl.h> 4206e79492SKenneth D. Merry #include <sys/uio.h> 43d3c7b9a0SKenneth D. Merry 44d3c7b9a0SKenneth D. Merry #include <machine/bus.h> 45d3c7b9a0SKenneth D. Merry #include <machine/resource.h> 46d3c7b9a0SKenneth D. Merry #include <sys/rman.h> 47d3c7b9a0SKenneth D. Merry 48d3c7b9a0SKenneth D. Merry #include <dev/pci/pcireg.h> 49d3c7b9a0SKenneth D. Merry #include <dev/pci/pcivar.h> 50d043c564SKenneth D. Merry #include <dev/pci/pci_private.h> 51d3c7b9a0SKenneth D. Merry 52d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2_type.h> 53d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2.h> 54d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2_ioc.h> 55d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2_cnfg.h> 56d043c564SKenneth D. Merry #include <dev/mps/mpi/mpi2_tool.h> 57d3c7b9a0SKenneth D. Merry 58d043c564SKenneth D. Merry #include <sys/queue.h> 59d043c564SKenneth D. Merry #include <sys/kthread.h> 60d043c564SKenneth D. Merry #include <dev/mps/mps_ioctl.h> 61d3c7b9a0SKenneth D. Merry #include <dev/mps/mpsvar.h> 62d3c7b9a0SKenneth D. Merry 63d3c7b9a0SKenneth D. Merry static int mps_pci_probe(device_t); 64d3c7b9a0SKenneth D. Merry static int mps_pci_attach(device_t); 65d3c7b9a0SKenneth D. Merry static int mps_pci_detach(device_t); 66d3c7b9a0SKenneth D. Merry static int mps_pci_suspend(device_t); 67d3c7b9a0SKenneth D. Merry static int mps_pci_resume(device_t); 68d3c7b9a0SKenneth D. Merry static void mps_pci_free(struct mps_softc *); 69d3c7b9a0SKenneth D. Merry static int mps_alloc_msix(struct mps_softc *sc, int msgs); 70d3c7b9a0SKenneth D. Merry static int mps_alloc_msi(struct mps_softc *sc, int msgs); 71252b2b4fSScott Long static int mps_pci_alloc_interrupts(struct mps_softc *sc); 72d3c7b9a0SKenneth D. Merry 73d3c7b9a0SKenneth D. Merry static device_method_t mps_methods[] = { 74d3c7b9a0SKenneth D. Merry DEVMETHOD(device_probe, mps_pci_probe), 75d3c7b9a0SKenneth D. Merry DEVMETHOD(device_attach, mps_pci_attach), 76d3c7b9a0SKenneth D. Merry DEVMETHOD(device_detach, mps_pci_detach), 77d3c7b9a0SKenneth D. Merry DEVMETHOD(device_suspend, mps_pci_suspend), 78d3c7b9a0SKenneth D. Merry DEVMETHOD(device_resume, mps_pci_resume), 794b7ec270SMarius Strobl 804b7ec270SMarius Strobl DEVMETHOD_END 81d3c7b9a0SKenneth D. Merry }; 82d3c7b9a0SKenneth D. Merry 83d3c7b9a0SKenneth D. Merry static driver_t mps_pci_driver = { 84d3c7b9a0SKenneth D. Merry "mps", 85d3c7b9a0SKenneth D. Merry mps_methods, 86d3c7b9a0SKenneth D. Merry sizeof(struct mps_softc) 87d3c7b9a0SKenneth D. Merry }; 88d3c7b9a0SKenneth D. Merry 89d3c7b9a0SKenneth D. Merry static devclass_t mps_devclass; 90d3c7b9a0SKenneth D. Merry DRIVER_MODULE(mps, pci, mps_pci_driver, mps_devclass, 0, 0); 9117a46b47SKenneth D. Merry MODULE_DEPEND(mps, cam, 1, 1, 1); 92d3c7b9a0SKenneth D. Merry 93d3c7b9a0SKenneth D. Merry struct mps_ident { 94d3c7b9a0SKenneth D. Merry uint16_t vendor; 95d3c7b9a0SKenneth D. Merry uint16_t device; 96d3c7b9a0SKenneth D. Merry uint16_t subvendor; 97d3c7b9a0SKenneth D. Merry uint16_t subdevice; 98d3c7b9a0SKenneth D. Merry u_int flags; 99d3c7b9a0SKenneth D. Merry const char *desc; 100d3c7b9a0SKenneth D. Merry } mps_identifiers[] = { 101d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2004, 102ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2004" }, 103d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2008, 104ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2008" }, 105d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_1, 106ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" }, 107d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_2, 108ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" }, 109d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_3, 110ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" }, 111d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_1, 112ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2116" }, 113d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_2, 114ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2116" }, 115d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_1, 116ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 117d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_2, 118ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 119d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_3, 120ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 121d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_4, 122ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 123d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_5, 124ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 125d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_6, 126ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 127d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_1, 128ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" }, 129d043c564SKenneth D. Merry // Add Customer specific vender/subdevice id before generic 130d043c564SKenneth D. Merry // (0xffff) vender/subdevice id. 131d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 132d043c564SKenneth D. Merry 0x8086, 0x3516, 0, "Intel(R) Integrated RAID Module RMS25JB080" }, 133d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 134d043c564SKenneth D. Merry 0x8086, 0x3517, 0, "Intel(R) Integrated RAID Module RMS25JB040" }, 135d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 136d043c564SKenneth D. Merry 0x8086, 0x3518, 0, "Intel(R) Integrated RAID Module RMS25KB080" }, 137d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 138d043c564SKenneth D. Merry 0x8086, 0x3519, 0, "Intel(R) Integrated RAID Module RMS25KB040" }, 139d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 140ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" }, 141d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_3, 142ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" }, 143d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SSS6200, 144ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SSS6200" }, 145d3c7b9a0SKenneth D. Merry { 0, 0, 0, 0, 0, NULL } 146d3c7b9a0SKenneth D. Merry }; 147d3c7b9a0SKenneth D. Merry 148d3c7b9a0SKenneth D. Merry static struct mps_ident * 149d3c7b9a0SKenneth D. Merry mps_find_ident(device_t dev) 150d3c7b9a0SKenneth D. Merry { 151d3c7b9a0SKenneth D. Merry struct mps_ident *m; 152d3c7b9a0SKenneth D. Merry 153d3c7b9a0SKenneth D. Merry for (m = mps_identifiers; m->vendor != 0; m++) { 154d3c7b9a0SKenneth D. Merry if (m->vendor != pci_get_vendor(dev)) 155d3c7b9a0SKenneth D. Merry continue; 156d3c7b9a0SKenneth D. Merry if (m->device != pci_get_device(dev)) 157d3c7b9a0SKenneth D. Merry continue; 158d3c7b9a0SKenneth D. Merry if ((m->subvendor != 0xffff) && 159d3c7b9a0SKenneth D. Merry (m->subvendor != pci_get_subvendor(dev))) 160d3c7b9a0SKenneth D. Merry continue; 161d3c7b9a0SKenneth D. Merry if ((m->subdevice != 0xffff) && 162d3c7b9a0SKenneth D. Merry (m->subdevice != pci_get_subdevice(dev))) 163d3c7b9a0SKenneth D. Merry continue; 164d3c7b9a0SKenneth D. Merry return (m); 165d3c7b9a0SKenneth D. Merry } 166d3c7b9a0SKenneth D. Merry 167d3c7b9a0SKenneth D. Merry return (NULL); 168d3c7b9a0SKenneth D. Merry } 169d3c7b9a0SKenneth D. Merry 170d3c7b9a0SKenneth D. Merry static int 171d3c7b9a0SKenneth D. Merry mps_pci_probe(device_t dev) 172d3c7b9a0SKenneth D. Merry { 173d3c7b9a0SKenneth D. Merry struct mps_ident *id; 174d3c7b9a0SKenneth D. Merry 175d3c7b9a0SKenneth D. Merry if ((id = mps_find_ident(dev)) != NULL) { 176d3c7b9a0SKenneth D. Merry device_set_desc(dev, id->desc); 177bab89358SKenneth D. Merry return (BUS_PROBE_DEFAULT); 178d3c7b9a0SKenneth D. Merry } 179d3c7b9a0SKenneth D. Merry return (ENXIO); 180d3c7b9a0SKenneth D. Merry } 181d3c7b9a0SKenneth D. Merry 182d3c7b9a0SKenneth D. Merry static int 183d3c7b9a0SKenneth D. Merry mps_pci_attach(device_t dev) 184d3c7b9a0SKenneth D. Merry { 185d3c7b9a0SKenneth D. Merry struct mps_softc *sc; 186d3c7b9a0SKenneth D. Merry struct mps_ident *m; 187d3c7b9a0SKenneth D. Merry int error; 188d3c7b9a0SKenneth D. Merry 189d3c7b9a0SKenneth D. Merry sc = device_get_softc(dev); 190d3c7b9a0SKenneth D. Merry bzero(sc, sizeof(*sc)); 191d3c7b9a0SKenneth D. Merry sc->mps_dev = dev; 192d3c7b9a0SKenneth D. Merry m = mps_find_ident(dev); 193d3c7b9a0SKenneth D. Merry sc->mps_flags = m->flags; 194d3c7b9a0SKenneth D. Merry 195252b2b4fSScott Long mps_get_tunables(sc); 196252b2b4fSScott Long 197d3c7b9a0SKenneth D. Merry /* Twiddle basic PCI config bits for a sanity check */ 198c68534f1SScott Long pci_enable_busmaster(dev); 199d3c7b9a0SKenneth D. Merry 200d3c7b9a0SKenneth D. Merry /* Allocate the System Interface Register Set */ 201d3c7b9a0SKenneth D. Merry sc->mps_regs_rid = PCIR_BAR(1); 202d3c7b9a0SKenneth D. Merry if ((sc->mps_regs_resource = bus_alloc_resource_any(dev, 203d3c7b9a0SKenneth D. Merry SYS_RES_MEMORY, &sc->mps_regs_rid, RF_ACTIVE)) == NULL) { 2041610f95cSScott Long mps_printf(sc, "Cannot allocate PCI registers\n"); 205d3c7b9a0SKenneth D. Merry return (ENXIO); 206d3c7b9a0SKenneth D. Merry } 207d3c7b9a0SKenneth D. Merry sc->mps_btag = rman_get_bustag(sc->mps_regs_resource); 208d3c7b9a0SKenneth D. Merry sc->mps_bhandle = rman_get_bushandle(sc->mps_regs_resource); 209d3c7b9a0SKenneth D. Merry 210d3c7b9a0SKenneth D. Merry /* Allocate the parent DMA tag */ 211d043c564SKenneth D. Merry if (bus_dma_tag_create( bus_get_dma_tag(dev), /* parent */ 212d3c7b9a0SKenneth D. Merry 1, 0, /* algnmnt, boundary */ 213d3c7b9a0SKenneth D. Merry BUS_SPACE_MAXADDR, /* lowaddr */ 214d3c7b9a0SKenneth D. Merry BUS_SPACE_MAXADDR, /* highaddr */ 215d3c7b9a0SKenneth D. Merry NULL, NULL, /* filter, filterarg */ 216d3c7b9a0SKenneth D. Merry BUS_SPACE_MAXSIZE_32BIT,/* maxsize */ 217d3c7b9a0SKenneth D. Merry BUS_SPACE_UNRESTRICTED, /* nsegments */ 218d3c7b9a0SKenneth D. Merry BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */ 219d3c7b9a0SKenneth D. Merry 0, /* flags */ 220d3c7b9a0SKenneth D. Merry NULL, NULL, /* lockfunc, lockarg */ 221d3c7b9a0SKenneth D. Merry &sc->mps_parent_dmat)) { 2221610f95cSScott Long mps_printf(sc, "Cannot allocate parent DMA tag\n"); 223d3c7b9a0SKenneth D. Merry mps_pci_free(sc); 224d3c7b9a0SKenneth D. Merry return (ENOMEM); 225d3c7b9a0SKenneth D. Merry } 226d3c7b9a0SKenneth D. Merry 227252b2b4fSScott Long if (((error = mps_pci_alloc_interrupts(sc)) != 0) || 228252b2b4fSScott Long ((error = mps_attach(sc)) != 0)) 229d3c7b9a0SKenneth D. Merry mps_pci_free(sc); 230d3c7b9a0SKenneth D. Merry 231d3c7b9a0SKenneth D. Merry return (error); 232d3c7b9a0SKenneth D. Merry } 233d3c7b9a0SKenneth D. Merry 234252b2b4fSScott Long /* 235252b2b4fSScott Long * Allocate, but don't assign interrupts early. Doing it before requesting 236252b2b4fSScott Long * the IOCFacts message informs the firmware that we want to do MSI-X 237252b2b4fSScott Long * multiqueue. We might not use all of the available messages, but there's 238252b2b4fSScott Long * no reason to re-alloc if we don't. 239252b2b4fSScott Long */ 240252b2b4fSScott Long static int 241252b2b4fSScott Long mps_pci_alloc_interrupts(struct mps_softc *sc) 242252b2b4fSScott Long { 243252b2b4fSScott Long device_t dev; 244252b2b4fSScott Long int error, msgs; 245252b2b4fSScott Long 246252b2b4fSScott Long dev = sc->mps_dev; 247252b2b4fSScott Long error = 0; 2482068b2aaSScott Long msgs = 0; 249252b2b4fSScott Long 250252b2b4fSScott Long if ((sc->disable_msix == 0) && 251252b2b4fSScott Long ((msgs = pci_msix_count(dev)) >= MPS_MSI_COUNT)) 252252b2b4fSScott Long error = mps_alloc_msix(sc, MPS_MSI_COUNT); 253252b2b4fSScott Long if ((error != 0) && (sc->disable_msi == 0) && 254252b2b4fSScott Long ((msgs = pci_msi_count(dev)) >= MPS_MSI_COUNT)) 255252b2b4fSScott Long error = mps_alloc_msi(sc, MPS_MSI_COUNT); 256*3d96cd78SScott Long if (error != 0) { 257*3d96cd78SScott Long /* 258*3d96cd78SScott Long * If neither MSI or MSI-X are avaiable, assume legacy INTx. 259*3d96cd78SScott Long * This also implies that there will be only 1 queue. 260*3d96cd78SScott Long */ 261*3d96cd78SScott Long sc->mps_flags |= MPS_FLAGS_INTX; 262*3d96cd78SScott Long msgs = 1; 263*3d96cd78SScott Long } else { 264*3d96cd78SScott Long sc->mps_flags |= MPS_FLAGS_MSI; 265*3d96cd78SScott Long msgs = 1; /* XXX */ 266*3d96cd78SScott Long } 267252b2b4fSScott Long 268252b2b4fSScott Long sc->msi_msgs = msgs; 269*3d96cd78SScott Long mps_dprint(sc, MPS_INIT, "Allocated %d interrupts\n", msgs); 270*3d96cd78SScott Long 271252b2b4fSScott Long return (error); 272252b2b4fSScott Long } 273252b2b4fSScott Long 274d3c7b9a0SKenneth D. Merry int 275d3c7b9a0SKenneth D. Merry mps_pci_setup_interrupts(struct mps_softc *sc) 276d3c7b9a0SKenneth D. Merry { 277d3c7b9a0SKenneth D. Merry device_t dev; 278*3d96cd78SScott Long void *ihandler; 279*3d96cd78SScott Long int i, error, rid, initial_rid; 280d3c7b9a0SKenneth D. Merry 281d3c7b9a0SKenneth D. Merry dev = sc->mps_dev; 282d3c7b9a0SKenneth D. Merry error = ENXIO; 283d3c7b9a0SKenneth D. Merry 284*3d96cd78SScott Long if (sc->mps_flags & MPS_FLAGS_INTX) { 285*3d96cd78SScott Long initial_rid = 0; 286*3d96cd78SScott Long ihandler = mps_intr; 287*3d96cd78SScott Long } else if (sc->mps_flags & MPS_FLAGS_MSI) { 288*3d96cd78SScott Long initial_rid = 1; 289*3d96cd78SScott Long ihandler = mps_intr_msi; 290d3c7b9a0SKenneth D. Merry } else { 291*3d96cd78SScott Long mps_dprint(sc, MPS_ERROR|MPS_INIT, 292*3d96cd78SScott Long "Unable to set up interrupts\n"); 293*3d96cd78SScott Long return (EINVAL); 294*3d96cd78SScott Long } 295*3d96cd78SScott Long 296*3d96cd78SScott Long for (i = 0; i < sc->msi_msgs; i++) { 297*3d96cd78SScott Long rid = i + initial_rid; 298*3d96cd78SScott Long sc->mps_irq_rid[i] = rid; 299*3d96cd78SScott Long sc->mps_irq[i] = bus_alloc_resource_any(dev, SYS_RES_IRQ, 300*3d96cd78SScott Long &sc->mps_irq_rid[i], RF_ACTIVE); 301d3c7b9a0SKenneth D. Merry if (sc->mps_irq[i] == NULL) { 302*3d96cd78SScott Long mps_dprint(sc, MPS_ERROR|MPS_INIT, 303*3d96cd78SScott Long "Cannot allocate interrupt RID%d\n", rid); 304*3d96cd78SScott Long break; 305d3c7b9a0SKenneth D. Merry } 306d3c7b9a0SKenneth D. Merry error = bus_setup_intr(dev, sc->mps_irq[i], 307*3d96cd78SScott Long INTR_TYPE_BIO | INTR_MPSAFE, NULL, ihandler, 308d3c7b9a0SKenneth D. Merry sc, &sc->mps_intrhand[i]); 309d3c7b9a0SKenneth D. Merry if (error) { 310*3d96cd78SScott Long mps_dprint(sc, MPS_ERROR|MPS_INIT, 311*3d96cd78SScott Long "Cannot setup interrupt RID %d\n", rid); 312d3c7b9a0SKenneth D. Merry break; 313d3c7b9a0SKenneth D. Merry } 314d3c7b9a0SKenneth D. Merry } 315*3d96cd78SScott Long 316*3d96cd78SScott Long mps_dprint(sc, MPS_INIT, "Set up %d interrupts\n", sc->msi_msgs); 317d3c7b9a0SKenneth D. Merry 318d3c7b9a0SKenneth D. Merry return (error); 319d3c7b9a0SKenneth D. Merry } 320d3c7b9a0SKenneth D. Merry 321d3c7b9a0SKenneth D. Merry static int 322d3c7b9a0SKenneth D. Merry mps_pci_detach(device_t dev) 323d3c7b9a0SKenneth D. Merry { 324d3c7b9a0SKenneth D. Merry struct mps_softc *sc; 325d3c7b9a0SKenneth D. Merry int error; 326d3c7b9a0SKenneth D. Merry 327d3c7b9a0SKenneth D. Merry sc = device_get_softc(dev); 328d3c7b9a0SKenneth D. Merry 329d3c7b9a0SKenneth D. Merry if ((error = mps_free(sc)) != 0) 330d3c7b9a0SKenneth D. Merry return (error); 331d3c7b9a0SKenneth D. Merry 332d3c7b9a0SKenneth D. Merry mps_pci_free(sc); 333d3c7b9a0SKenneth D. Merry return (0); 334d3c7b9a0SKenneth D. Merry } 335d3c7b9a0SKenneth D. Merry 336d3c7b9a0SKenneth D. Merry static void 337d3c7b9a0SKenneth D. Merry mps_pci_free(struct mps_softc *sc) 338d3c7b9a0SKenneth D. Merry { 339d3c7b9a0SKenneth D. Merry int i; 340d3c7b9a0SKenneth D. Merry 341d3c7b9a0SKenneth D. Merry if (sc->mps_parent_dmat != NULL) { 342d3c7b9a0SKenneth D. Merry bus_dma_tag_destroy(sc->mps_parent_dmat); 343d3c7b9a0SKenneth D. Merry } 344d3c7b9a0SKenneth D. Merry 345*3d96cd78SScott Long for (i = 0; i < sc->msi_msgs; i++) { 346d3c7b9a0SKenneth D. Merry if (sc->mps_irq[i] != NULL) { 347d3c7b9a0SKenneth D. Merry bus_teardown_intr(sc->mps_dev, sc->mps_irq[i], 348d3c7b9a0SKenneth D. Merry sc->mps_intrhand[i]); 349d3c7b9a0SKenneth D. Merry bus_release_resource(sc->mps_dev, SYS_RES_IRQ, 350d3c7b9a0SKenneth D. Merry sc->mps_irq_rid[i], sc->mps_irq[i]); 351d3c7b9a0SKenneth D. Merry } 352d3c7b9a0SKenneth D. Merry } 353d3c7b9a0SKenneth D. Merry 354*3d96cd78SScott Long if (sc->mps_flags & MPS_FLAGS_MSI) 355*3d96cd78SScott Long pci_release_msi(sc->mps_dev); 356d3c7b9a0SKenneth D. Merry 357d3c7b9a0SKenneth D. Merry if (sc->mps_regs_resource != NULL) { 358d3c7b9a0SKenneth D. Merry bus_release_resource(sc->mps_dev, SYS_RES_MEMORY, 359d3c7b9a0SKenneth D. Merry sc->mps_regs_rid, sc->mps_regs_resource); 360d3c7b9a0SKenneth D. Merry } 361d3c7b9a0SKenneth D. Merry 362d3c7b9a0SKenneth D. Merry return; 363d3c7b9a0SKenneth D. Merry } 364d3c7b9a0SKenneth D. Merry 365d3c7b9a0SKenneth D. Merry static int 366d3c7b9a0SKenneth D. Merry mps_pci_suspend(device_t dev) 367d3c7b9a0SKenneth D. Merry { 368d3c7b9a0SKenneth D. Merry return (EINVAL); 369d3c7b9a0SKenneth D. Merry } 370d3c7b9a0SKenneth D. Merry 371d3c7b9a0SKenneth D. Merry static int 372d3c7b9a0SKenneth D. Merry mps_pci_resume(device_t dev) 373d3c7b9a0SKenneth D. Merry { 374d3c7b9a0SKenneth D. Merry return (EINVAL); 375d3c7b9a0SKenneth D. Merry } 376d3c7b9a0SKenneth D. Merry 377d3c7b9a0SKenneth D. Merry static int 378d3c7b9a0SKenneth D. Merry mps_alloc_msix(struct mps_softc *sc, int msgs) 379d3c7b9a0SKenneth D. Merry { 380d3c7b9a0SKenneth D. Merry int error; 381d3c7b9a0SKenneth D. Merry 382d3c7b9a0SKenneth D. Merry error = pci_alloc_msix(sc->mps_dev, &msgs); 383d3c7b9a0SKenneth D. Merry return (error); 384d3c7b9a0SKenneth D. Merry } 385d3c7b9a0SKenneth D. Merry 386d3c7b9a0SKenneth D. Merry static int 387d3c7b9a0SKenneth D. Merry mps_alloc_msi(struct mps_softc *sc, int msgs) 388d3c7b9a0SKenneth D. Merry { 389d3c7b9a0SKenneth D. Merry int error; 390d3c7b9a0SKenneth D. Merry 391d3c7b9a0SKenneth D. Merry error = pci_alloc_msi(sc->mps_dev, &msgs); 392d3c7b9a0SKenneth D. Merry return (error); 393d3c7b9a0SKenneth D. Merry } 394d3c7b9a0SKenneth D. Merry 395d043c564SKenneth D. Merry int 396d043c564SKenneth D. Merry mps_pci_restore(struct mps_softc *sc) 397d043c564SKenneth D. Merry { 398d043c564SKenneth D. Merry struct pci_devinfo *dinfo; 399d043c564SKenneth D. Merry 400d043c564SKenneth D. Merry mps_dprint(sc, MPS_TRACE, "%s\n", __func__); 401d043c564SKenneth D. Merry 402d043c564SKenneth D. Merry dinfo = device_get_ivars(sc->mps_dev); 403d043c564SKenneth D. Merry if (dinfo == NULL) { 404d043c564SKenneth D. Merry mps_dprint(sc, MPS_FAULT, "%s: NULL dinfo\n", __func__); 405d043c564SKenneth D. Merry return (EINVAL); 406d043c564SKenneth D. Merry } 407d043c564SKenneth D. Merry 408d043c564SKenneth D. Merry pci_cfg_restore(sc->mps_dev, dinfo); 409d043c564SKenneth D. Merry return (0); 410d043c564SKenneth D. Merry } 411d043c564SKenneth D. Merry 412