1d3c7b9a0SKenneth D. Merry /*- 24d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause 3718cf2ccSPedro F. Giffuni * 4d3c7b9a0SKenneth D. Merry * Copyright (c) 2009 Yahoo! Inc. 5d3c7b9a0SKenneth D. Merry * All rights reserved. 6d3c7b9a0SKenneth D. Merry * 7d3c7b9a0SKenneth D. Merry * Redistribution and use in source and binary forms, with or without 8d3c7b9a0SKenneth D. Merry * modification, are permitted provided that the following conditions 9d3c7b9a0SKenneth D. Merry * are met: 10d3c7b9a0SKenneth D. Merry * 1. Redistributions of source code must retain the above copyright 11d3c7b9a0SKenneth D. Merry * notice, this list of conditions and the following disclaimer. 12d3c7b9a0SKenneth D. Merry * 2. Redistributions in binary form must reproduce the above copyright 13d3c7b9a0SKenneth D. Merry * notice, this list of conditions and the following disclaimer in the 14d3c7b9a0SKenneth D. Merry * documentation and/or other materials provided with the distribution. 15d3c7b9a0SKenneth D. Merry * 16d3c7b9a0SKenneth D. Merry * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17d3c7b9a0SKenneth D. Merry * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18d3c7b9a0SKenneth D. Merry * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19d3c7b9a0SKenneth D. Merry * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20d3c7b9a0SKenneth D. Merry * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21d3c7b9a0SKenneth D. Merry * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22d3c7b9a0SKenneth D. Merry * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23d3c7b9a0SKenneth D. Merry * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24d3c7b9a0SKenneth D. Merry * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25d3c7b9a0SKenneth D. Merry * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26d3c7b9a0SKenneth D. Merry * SUCH DAMAGE. 27d3c7b9a0SKenneth D. Merry */ 28d3c7b9a0SKenneth D. Merry 29d3c7b9a0SKenneth D. Merry #include <sys/cdefs.h> 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 struct mps_ident { 90d3c7b9a0SKenneth D. Merry uint16_t vendor; 91d3c7b9a0SKenneth D. Merry uint16_t device; 92d3c7b9a0SKenneth D. Merry uint16_t subvendor; 93d3c7b9a0SKenneth D. Merry uint16_t subdevice; 94d3c7b9a0SKenneth D. Merry u_int flags; 95d3c7b9a0SKenneth D. Merry const char *desc; 96d3c7b9a0SKenneth D. Merry } mps_identifiers[] = { 97d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2004, 98ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2004" }, 99d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2008, 100ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2008" }, 101d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_1, 102ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" }, 103d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_2, 104ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" }, 105d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_3, 106ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" }, 107d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_1, 108ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2116" }, 109d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_2, 110ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2116" }, 111d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_1, 112ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 113d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_2, 114ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 115d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_3, 116ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 117d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_4, 118ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 119d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_5, 120ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 121d3c7b9a0SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_6, 122ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" }, 123d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_1, 124ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" }, 125*a9d7f098SGordon Bergling // Add Customer specific vendor/subdevice id before generic 126*a9d7f098SGordon Bergling // (0xffff) vendor/subdevice id. 127d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 128d043c564SKenneth D. Merry 0x8086, 0x3516, 0, "Intel(R) Integrated RAID Module RMS25JB080" }, 129d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 130d043c564SKenneth D. Merry 0x8086, 0x3517, 0, "Intel(R) Integrated RAID Module RMS25JB040" }, 131d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 132d043c564SKenneth D. Merry 0x8086, 0x3518, 0, "Intel(R) Integrated RAID Module RMS25KB080" }, 133d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 134d043c564SKenneth D. Merry 0x8086, 0x3519, 0, "Intel(R) Integrated RAID Module RMS25KB040" }, 135d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2, 136ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" }, 137d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_3, 138ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" }, 139d043c564SKenneth D. Merry { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SSS6200, 140ef065d89SStephen McConnell 0xffff, 0xffff, 0, "Avago Technologies (LSI) SSS6200" }, 141d3c7b9a0SKenneth D. Merry { 0, 0, 0, 0, 0, NULL } 142d3c7b9a0SKenneth D. Merry }; 143d3c7b9a0SKenneth D. Merry 144d48ddc5fSJohn Baldwin DRIVER_MODULE(mps, pci, mps_pci_driver, 0, 0); 145d1df7fddSConrad Meyer MODULE_DEPEND(mps, cam, 1, 1, 1); 1460dc34160SWarner Losh MODULE_PNP_INFO("U16:vendor;U16:device;U16:subvendor;U16:subdevice", pci, mps, 1470dc34160SWarner Losh mps_identifiers, nitems(mps_identifiers) - 1); 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 { 18574c781edSScott Long bus_dma_template_t t; 186d3c7b9a0SKenneth D. Merry struct mps_softc *sc; 187d3c7b9a0SKenneth D. Merry struct mps_ident *m; 188d3c7b9a0SKenneth D. Merry int error; 189d3c7b9a0SKenneth D. Merry 190d3c7b9a0SKenneth D. Merry sc = device_get_softc(dev); 191d3c7b9a0SKenneth D. Merry bzero(sc, sizeof(*sc)); 192d3c7b9a0SKenneth D. Merry sc->mps_dev = dev; 193d3c7b9a0SKenneth D. Merry m = mps_find_ident(dev); 194d3c7b9a0SKenneth D. Merry sc->mps_flags = m->flags; 195d3c7b9a0SKenneth D. Merry 196252b2b4fSScott Long mps_get_tunables(sc); 197252b2b4fSScott Long 198d3c7b9a0SKenneth D. Merry /* Twiddle basic PCI config bits for a sanity check */ 199c68534f1SScott Long pci_enable_busmaster(dev); 200d3c7b9a0SKenneth D. Merry 201d3c7b9a0SKenneth D. Merry /* Allocate the System Interface Register Set */ 202d3c7b9a0SKenneth D. Merry sc->mps_regs_rid = PCIR_BAR(1); 203d3c7b9a0SKenneth D. Merry if ((sc->mps_regs_resource = bus_alloc_resource_any(dev, 204d3c7b9a0SKenneth D. Merry SYS_RES_MEMORY, &sc->mps_regs_rid, RF_ACTIVE)) == NULL) { 2051610f95cSScott Long mps_printf(sc, "Cannot allocate PCI registers\n"); 206d3c7b9a0SKenneth D. Merry return (ENXIO); 207d3c7b9a0SKenneth D. Merry } 208d3c7b9a0SKenneth D. Merry sc->mps_btag = rman_get_bustag(sc->mps_regs_resource); 209d3c7b9a0SKenneth D. Merry sc->mps_bhandle = rman_get_bushandle(sc->mps_regs_resource); 210d3c7b9a0SKenneth D. Merry 211d3c7b9a0SKenneth D. Merry /* Allocate the parent DMA tag */ 2121002529eSScott Long bus_dma_template_init(&t, bus_get_dma_tag(dev)); 2131002529eSScott Long if (bus_dma_template_tag(&t, &sc->mps_parent_dmat)) { 2141610f95cSScott Long mps_printf(sc, "Cannot allocate parent DMA tag\n"); 215d3c7b9a0SKenneth D. Merry mps_pci_free(sc); 216d3c7b9a0SKenneth D. Merry return (ENOMEM); 217d3c7b9a0SKenneth D. Merry } 218d3c7b9a0SKenneth D. Merry 219252b2b4fSScott Long if (((error = mps_pci_alloc_interrupts(sc)) != 0) || 220252b2b4fSScott Long ((error = mps_attach(sc)) != 0)) 221d3c7b9a0SKenneth D. Merry mps_pci_free(sc); 222d3c7b9a0SKenneth D. Merry 223d3c7b9a0SKenneth D. Merry return (error); 224d3c7b9a0SKenneth D. Merry } 225d3c7b9a0SKenneth D. Merry 226252b2b4fSScott Long /* 227252b2b4fSScott Long * Allocate, but don't assign interrupts early. Doing it before requesting 228252b2b4fSScott Long * the IOCFacts message informs the firmware that we want to do MSI-X 229252b2b4fSScott Long * multiqueue. We might not use all of the available messages, but there's 230252b2b4fSScott Long * no reason to re-alloc if we don't. 231252b2b4fSScott Long */ 232252b2b4fSScott Long static int 233252b2b4fSScott Long mps_pci_alloc_interrupts(struct mps_softc *sc) 234252b2b4fSScott Long { 235252b2b4fSScott Long device_t dev; 236252b2b4fSScott Long int error, msgs; 237252b2b4fSScott Long 238252b2b4fSScott Long dev = sc->mps_dev; 239252b2b4fSScott Long error = 0; 2402068b2aaSScott Long msgs = 0; 241252b2b4fSScott Long 2423c5ac992SScott Long if (sc->disable_msix == 0) { 2433c5ac992SScott Long msgs = pci_msix_count(dev); 2443c5ac992SScott Long mps_dprint(sc, MPS_INIT, "Counted %d MSI-X messages\n", msgs); 2453c5ac992SScott Long msgs = min(msgs, sc->max_msix); 2463c5ac992SScott Long msgs = min(msgs, MPS_MSIX_MAX); 2473c5ac992SScott Long msgs = min(msgs, 1); /* XXX */ 2483c5ac992SScott Long if (msgs != 0) { 2497eed4c18SScott Long mps_dprint(sc, MPS_INIT, "Attempting to allocate %d " 2507eed4c18SScott Long "MSI-X messages\n", msgs); 2513c5ac992SScott Long error = mps_alloc_msix(sc, msgs); 2523c5ac992SScott Long } 2533c5ac992SScott Long } 2543c5ac992SScott Long if (((error != 0) || (msgs == 0)) && (sc->disable_msi == 0)) { 2553c5ac992SScott Long msgs = pci_msi_count(dev); 2563c5ac992SScott Long mps_dprint(sc, MPS_INIT, "Counted %d MSI messages\n", msgs); 2573c5ac992SScott Long msgs = min(msgs, MPS_MSI_MAX); 2583c5ac992SScott Long if (msgs != 0) { 2597eed4c18SScott Long mps_dprint(sc, MPS_INIT, "Attempting to allocate %d " 2607eed4c18SScott Long "MSI messages\n", MPS_MSI_MAX); 2613c5ac992SScott Long error = mps_alloc_msi(sc, MPS_MSI_MAX); 2623c5ac992SScott Long } 2633c5ac992SScott Long } 2643c5ac992SScott Long if ((error != 0) || (msgs == 0)) { 2653d96cd78SScott Long /* 2663d96cd78SScott Long * If neither MSI or MSI-X are avaiable, assume legacy INTx. 2673d96cd78SScott Long * This also implies that there will be only 1 queue. 2683d96cd78SScott Long */ 2693c5ac992SScott Long mps_dprint(sc, MPS_INIT, "Falling back to legacy INTx\n"); 2703d96cd78SScott Long sc->mps_flags |= MPS_FLAGS_INTX; 2713d96cd78SScott Long msgs = 1; 2723c5ac992SScott Long } else 2733d96cd78SScott Long sc->mps_flags |= MPS_FLAGS_MSI; 274252b2b4fSScott Long 275252b2b4fSScott Long sc->msi_msgs = msgs; 2763d96cd78SScott Long mps_dprint(sc, MPS_INIT, "Allocated %d interrupts\n", msgs); 2773d96cd78SScott Long 278252b2b4fSScott Long return (error); 279252b2b4fSScott Long } 280252b2b4fSScott Long 281d3c7b9a0SKenneth D. Merry int 282d3c7b9a0SKenneth D. Merry mps_pci_setup_interrupts(struct mps_softc *sc) 283d3c7b9a0SKenneth D. Merry { 284d3c7b9a0SKenneth D. Merry device_t dev; 285bec09074SScott Long struct mps_queue *q; 2863d96cd78SScott Long void *ihandler; 2873d96cd78SScott Long int i, error, rid, initial_rid; 288d3c7b9a0SKenneth D. Merry 289d3c7b9a0SKenneth D. Merry dev = sc->mps_dev; 290d3c7b9a0SKenneth D. Merry error = ENXIO; 291d3c7b9a0SKenneth D. Merry 2923d96cd78SScott Long if (sc->mps_flags & MPS_FLAGS_INTX) { 2933d96cd78SScott Long initial_rid = 0; 2943d96cd78SScott Long ihandler = mps_intr; 2953d96cd78SScott Long } else if (sc->mps_flags & MPS_FLAGS_MSI) { 2963d96cd78SScott Long initial_rid = 1; 2973d96cd78SScott Long ihandler = mps_intr_msi; 298d3c7b9a0SKenneth D. Merry } else { 2993d96cd78SScott Long mps_dprint(sc, MPS_ERROR|MPS_INIT, 3003d96cd78SScott Long "Unable to set up interrupts\n"); 3013d96cd78SScott Long return (EINVAL); 3023d96cd78SScott Long } 3033d96cd78SScott Long 3043d96cd78SScott Long for (i = 0; i < sc->msi_msgs; i++) { 305bec09074SScott Long q = &sc->queues[i]; 3063d96cd78SScott Long rid = i + initial_rid; 307bec09074SScott Long q->irq_rid = rid; 308bec09074SScott Long q->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, 309bec09074SScott Long &q->irq_rid, RF_ACTIVE); 310bec09074SScott Long if (q->irq == NULL) { 3113d96cd78SScott Long mps_dprint(sc, MPS_ERROR|MPS_INIT, 3123d96cd78SScott Long "Cannot allocate interrupt RID %d\n", rid); 3133c5ac992SScott Long sc->msi_msgs = i; 3143d96cd78SScott Long break; 315d3c7b9a0SKenneth D. Merry } 316bec09074SScott Long error = bus_setup_intr(dev, q->irq, 3173d96cd78SScott Long INTR_TYPE_BIO | INTR_MPSAFE, NULL, ihandler, 318bec09074SScott Long sc, &q->intrhand); 319d3c7b9a0SKenneth D. Merry if (error) { 3203d96cd78SScott Long mps_dprint(sc, MPS_ERROR|MPS_INIT, 3213d96cd78SScott Long "Cannot setup interrupt RID %d\n", rid); 3223c5ac992SScott Long sc->msi_msgs = i; 323d3c7b9a0SKenneth D. Merry break; 324d3c7b9a0SKenneth D. Merry } 325d3c7b9a0SKenneth D. Merry } 3263d96cd78SScott Long 3273d96cd78SScott Long mps_dprint(sc, MPS_INIT, "Set up %d interrupts\n", sc->msi_msgs); 328d3c7b9a0SKenneth D. Merry 329d3c7b9a0SKenneth D. Merry return (error); 330d3c7b9a0SKenneth D. Merry } 331d3c7b9a0SKenneth D. Merry 332d3c7b9a0SKenneth D. Merry static int 333d3c7b9a0SKenneth D. Merry mps_pci_detach(device_t dev) 334d3c7b9a0SKenneth D. Merry { 335d3c7b9a0SKenneth D. Merry struct mps_softc *sc; 336d3c7b9a0SKenneth D. Merry int error; 337d3c7b9a0SKenneth D. Merry 338d3c7b9a0SKenneth D. Merry sc = device_get_softc(dev); 339d3c7b9a0SKenneth D. Merry 340d3c7b9a0SKenneth D. Merry if ((error = mps_free(sc)) != 0) 341d3c7b9a0SKenneth D. Merry return (error); 342d3c7b9a0SKenneth D. Merry 343d3c7b9a0SKenneth D. Merry mps_pci_free(sc); 344d3c7b9a0SKenneth D. Merry return (0); 345d3c7b9a0SKenneth D. Merry } 346d3c7b9a0SKenneth D. Merry 347bec09074SScott Long void 348bec09074SScott Long mps_pci_free_interrupts(struct mps_softc *sc) 349bec09074SScott Long { 350bec09074SScott Long struct mps_queue *q; 351bec09074SScott Long int i; 352bec09074SScott Long 353bec09074SScott Long if (sc->queues == NULL) 354bec09074SScott Long return; 355bec09074SScott Long 356bec09074SScott Long for (i = 0; i < sc->msi_msgs; i++) { 357bec09074SScott Long q = &sc->queues[i]; 358bec09074SScott Long if (q->irq != NULL) { 359bec09074SScott Long bus_teardown_intr(sc->mps_dev, q->irq, 360bec09074SScott Long q->intrhand); 361bec09074SScott Long bus_release_resource(sc->mps_dev, SYS_RES_IRQ, 362bec09074SScott Long q->irq_rid, q->irq); 363bec09074SScott Long } 364bec09074SScott Long } 365bec09074SScott Long } 366bec09074SScott Long 367d3c7b9a0SKenneth D. Merry static void 368d3c7b9a0SKenneth D. Merry mps_pci_free(struct mps_softc *sc) 369d3c7b9a0SKenneth D. Merry { 370d3c7b9a0SKenneth D. Merry 371d3c7b9a0SKenneth D. Merry if (sc->mps_parent_dmat != NULL) { 372d3c7b9a0SKenneth D. Merry bus_dma_tag_destroy(sc->mps_parent_dmat); 373d3c7b9a0SKenneth D. Merry } 374d3c7b9a0SKenneth D. Merry 375bec09074SScott Long mps_pci_free_interrupts(sc); 376d3c7b9a0SKenneth D. Merry 3773d96cd78SScott Long if (sc->mps_flags & MPS_FLAGS_MSI) 3783d96cd78SScott Long pci_release_msi(sc->mps_dev); 379d3c7b9a0SKenneth D. Merry 380d3c7b9a0SKenneth D. Merry if (sc->mps_regs_resource != NULL) { 381d3c7b9a0SKenneth D. Merry bus_release_resource(sc->mps_dev, SYS_RES_MEMORY, 382d3c7b9a0SKenneth D. Merry sc->mps_regs_rid, sc->mps_regs_resource); 383d3c7b9a0SKenneth D. Merry } 384d3c7b9a0SKenneth D. Merry 385d3c7b9a0SKenneth D. Merry return; 386d3c7b9a0SKenneth D. Merry } 387d3c7b9a0SKenneth D. Merry 388d3c7b9a0SKenneth D. Merry static int 389d3c7b9a0SKenneth D. Merry mps_pci_suspend(device_t dev) 390d3c7b9a0SKenneth D. Merry { 391d3c7b9a0SKenneth D. Merry return (EINVAL); 392d3c7b9a0SKenneth D. Merry } 393d3c7b9a0SKenneth D. Merry 394d3c7b9a0SKenneth D. Merry static int 395d3c7b9a0SKenneth D. Merry mps_pci_resume(device_t dev) 396d3c7b9a0SKenneth D. Merry { 397d3c7b9a0SKenneth D. Merry return (EINVAL); 398d3c7b9a0SKenneth D. Merry } 399d3c7b9a0SKenneth D. Merry 400d3c7b9a0SKenneth D. Merry static int 401d3c7b9a0SKenneth D. Merry mps_alloc_msix(struct mps_softc *sc, int msgs) 402d3c7b9a0SKenneth D. Merry { 403d3c7b9a0SKenneth D. Merry int error; 404d3c7b9a0SKenneth D. Merry 405d3c7b9a0SKenneth D. Merry error = pci_alloc_msix(sc->mps_dev, &msgs); 406d3c7b9a0SKenneth D. Merry return (error); 407d3c7b9a0SKenneth D. Merry } 408d3c7b9a0SKenneth D. Merry 409d3c7b9a0SKenneth D. Merry static int 410d3c7b9a0SKenneth D. Merry mps_alloc_msi(struct mps_softc *sc, int msgs) 411d3c7b9a0SKenneth D. Merry { 412d3c7b9a0SKenneth D. Merry int error; 413d3c7b9a0SKenneth D. Merry 414d3c7b9a0SKenneth D. Merry error = pci_alloc_msi(sc->mps_dev, &msgs); 415d3c7b9a0SKenneth D. Merry return (error); 416d3c7b9a0SKenneth D. Merry } 417d3c7b9a0SKenneth D. Merry 418d043c564SKenneth D. Merry int 419d043c564SKenneth D. Merry mps_pci_restore(struct mps_softc *sc) 420d043c564SKenneth D. Merry { 421d043c564SKenneth D. Merry struct pci_devinfo *dinfo; 422d043c564SKenneth D. Merry 423d043c564SKenneth D. Merry mps_dprint(sc, MPS_TRACE, "%s\n", __func__); 424d043c564SKenneth D. Merry 425d043c564SKenneth D. Merry dinfo = device_get_ivars(sc->mps_dev); 426d043c564SKenneth D. Merry if (dinfo == NULL) { 427d043c564SKenneth D. Merry mps_dprint(sc, MPS_FAULT, "%s: NULL dinfo\n", __func__); 428d043c564SKenneth D. Merry return (EINVAL); 429d043c564SKenneth D. Merry } 430d043c564SKenneth D. Merry 431d043c564SKenneth D. Merry pci_cfg_restore(sc->mps_dev, dinfo); 432d043c564SKenneth D. Merry return (0); 433d043c564SKenneth D. Merry } 434