xref: /freebsd/sys/dev/mps/mps_pci.c (revision a9d7f098b86576006f5aeb312521bfde5ac77c77)
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