xref: /freebsd/sys/dev/mps/mps_pci.c (revision d1df7fdd040a25a6d61d04a3e04a931aa75f3094)
1d3c7b9a0SKenneth D. Merry /*-
2718cf2ccSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
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>
30d3c7b9a0SKenneth D. Merry __FBSDID("$FreeBSD$");
31d3c7b9a0SKenneth D. Merry 
32ef065d89SStephen McConnell /* PCI/PCI-X/PCIe bus interface for the Avago Tech (LSI) MPT2 controllers */
33d3c7b9a0SKenneth D. Merry 
34d043c564SKenneth D. Merry /* TODO Move headers to mpsvar */
35d3c7b9a0SKenneth D. Merry #include <sys/types.h>
36d3c7b9a0SKenneth D. Merry #include <sys/param.h>
37d3c7b9a0SKenneth D. Merry #include <sys/systm.h>
38d3c7b9a0SKenneth D. Merry #include <sys/kernel.h>
39d3c7b9a0SKenneth D. Merry #include <sys/module.h>
40d3c7b9a0SKenneth D. Merry #include <sys/bus.h>
41d3c7b9a0SKenneth D. Merry #include <sys/conf.h>
42d3c7b9a0SKenneth D. Merry #include <sys/malloc.h>
43d3c7b9a0SKenneth D. Merry #include <sys/sysctl.h>
4406e79492SKenneth D. Merry #include <sys/uio.h>
45d3c7b9a0SKenneth D. Merry 
46d3c7b9a0SKenneth D. Merry #include <machine/bus.h>
47d3c7b9a0SKenneth D. Merry #include <machine/resource.h>
48d3c7b9a0SKenneth D. Merry #include <sys/rman.h>
49d3c7b9a0SKenneth D. Merry 
50d3c7b9a0SKenneth D. Merry #include <dev/pci/pcireg.h>
51d3c7b9a0SKenneth D. Merry #include <dev/pci/pcivar.h>
52d043c564SKenneth D. Merry #include <dev/pci/pci_private.h>
53d3c7b9a0SKenneth D. Merry 
54d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2_type.h>
55d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2.h>
56d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2_ioc.h>
57d3c7b9a0SKenneth D. Merry #include <dev/mps/mpi/mpi2_cnfg.h>
58d043c564SKenneth D. Merry #include <dev/mps/mpi/mpi2_tool.h>
59d3c7b9a0SKenneth D. Merry 
60d043c564SKenneth D. Merry #include <sys/queue.h>
61d043c564SKenneth D. Merry #include <sys/kthread.h>
62d043c564SKenneth D. Merry #include <dev/mps/mps_ioctl.h>
63d3c7b9a0SKenneth D. Merry #include <dev/mps/mpsvar.h>
64d3c7b9a0SKenneth D. Merry 
65d3c7b9a0SKenneth D. Merry static int	mps_pci_probe(device_t);
66d3c7b9a0SKenneth D. Merry static int	mps_pci_attach(device_t);
67d3c7b9a0SKenneth D. Merry static int	mps_pci_detach(device_t);
68d3c7b9a0SKenneth D. Merry static int	mps_pci_suspend(device_t);
69d3c7b9a0SKenneth D. Merry static int	mps_pci_resume(device_t);
70d3c7b9a0SKenneth D. Merry static void	mps_pci_free(struct mps_softc *);
71d3c7b9a0SKenneth D. Merry static int	mps_alloc_msix(struct mps_softc *sc, int msgs);
72d3c7b9a0SKenneth D. Merry static int	mps_alloc_msi(struct mps_softc *sc, int msgs);
73252b2b4fSScott Long static int	mps_pci_alloc_interrupts(struct mps_softc *sc);
74d3c7b9a0SKenneth D. Merry 
75d3c7b9a0SKenneth D. Merry static device_method_t mps_methods[] = {
76d3c7b9a0SKenneth D. Merry 	DEVMETHOD(device_probe,		mps_pci_probe),
77d3c7b9a0SKenneth D. Merry 	DEVMETHOD(device_attach,	mps_pci_attach),
78d3c7b9a0SKenneth D. Merry 	DEVMETHOD(device_detach,	mps_pci_detach),
79d3c7b9a0SKenneth D. Merry 	DEVMETHOD(device_suspend,	mps_pci_suspend),
80d3c7b9a0SKenneth D. Merry 	DEVMETHOD(device_resume,	mps_pci_resume),
814b7ec270SMarius Strobl 
824b7ec270SMarius Strobl 	DEVMETHOD_END
83d3c7b9a0SKenneth D. Merry };
84d3c7b9a0SKenneth D. Merry 
85d3c7b9a0SKenneth D. Merry static driver_t mps_pci_driver = {
86d3c7b9a0SKenneth D. Merry 	"mps",
87d3c7b9a0SKenneth D. Merry 	mps_methods,
88d3c7b9a0SKenneth D. Merry 	sizeof(struct mps_softc)
89d3c7b9a0SKenneth D. Merry };
90d3c7b9a0SKenneth D. Merry 
91d3c7b9a0SKenneth D. Merry struct mps_ident {
92d3c7b9a0SKenneth D. Merry 	uint16_t	vendor;
93d3c7b9a0SKenneth D. Merry 	uint16_t	device;
94d3c7b9a0SKenneth D. Merry 	uint16_t	subvendor;
95d3c7b9a0SKenneth D. Merry 	uint16_t	subdevice;
96d3c7b9a0SKenneth D. Merry 	u_int		flags;
97d3c7b9a0SKenneth D. Merry 	const char	*desc;
98d3c7b9a0SKenneth D. Merry } mps_identifiers[] = {
99d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2004,
100ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2004" },
101d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2008,
102ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2008" },
103d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_1,
104ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" },
105d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_2,
106ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" },
107d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_3,
108ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2108" },
109d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_1,
110ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2116" },
111d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_2,
112ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2116" },
113d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_1,
114ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" },
115d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_2,
116ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" },
117d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_3,
118ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" },
119d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_4,
120ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" },
121d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_5,
122ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" },
123d3c7b9a0SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_6,
124ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2208" },
125d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_1,
126ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" },
127d043c564SKenneth D. Merry 	// Add Customer specific vender/subdevice id before generic
128d043c564SKenneth D. Merry 	// (0xffff) vender/subdevice id.
129d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2,
130d043c564SKenneth D. Merry 	    0x8086, 0x3516, 0, "Intel(R) Integrated RAID Module RMS25JB080" },
131d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2,
132d043c564SKenneth D. Merry 	    0x8086, 0x3517, 0, "Intel(R) Integrated RAID Module RMS25JB040" },
133d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2,
134d043c564SKenneth D. Merry 	    0x8086, 0x3518, 0, "Intel(R) Integrated RAID Module RMS25KB080" },
135d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2,
136d043c564SKenneth D. Merry 	    0x8086, 0x3519, 0, "Intel(R) Integrated RAID Module RMS25KB040" },
137d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2,
138ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" },
139d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_3,
140ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS2308" },
141d043c564SKenneth D. Merry 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SSS6200,
142ef065d89SStephen McConnell 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SSS6200" },
143d3c7b9a0SKenneth D. Merry 	{ 0, 0, 0, 0, 0, NULL }
144d3c7b9a0SKenneth D. Merry };
145d3c7b9a0SKenneth D. Merry 
1460dc34160SWarner Losh static devclass_t	mps_devclass;
1470dc34160SWarner Losh DRIVER_MODULE(mps, pci, mps_pci_driver, mps_devclass, 0, 0);
148*d1df7fddSConrad Meyer MODULE_DEPEND(mps, cam, 1, 1, 1);
1490dc34160SWarner Losh MODULE_PNP_INFO("U16:vendor;U16:device;U16:subvendor;U16:subdevice", pci, mps,
1500dc34160SWarner Losh     mps_identifiers, nitems(mps_identifiers) - 1);
151d3c7b9a0SKenneth D. Merry static struct mps_ident *
152d3c7b9a0SKenneth D. Merry mps_find_ident(device_t dev)
153d3c7b9a0SKenneth D. Merry {
154d3c7b9a0SKenneth D. Merry 	struct mps_ident *m;
155d3c7b9a0SKenneth D. Merry 
156d3c7b9a0SKenneth D. Merry 	for (m = mps_identifiers; m->vendor != 0; m++) {
157d3c7b9a0SKenneth D. Merry 		if (m->vendor != pci_get_vendor(dev))
158d3c7b9a0SKenneth D. Merry 			continue;
159d3c7b9a0SKenneth D. Merry 		if (m->device != pci_get_device(dev))
160d3c7b9a0SKenneth D. Merry 			continue;
161d3c7b9a0SKenneth D. Merry 		if ((m->subvendor != 0xffff) &&
162d3c7b9a0SKenneth D. Merry 		    (m->subvendor != pci_get_subvendor(dev)))
163d3c7b9a0SKenneth D. Merry 			continue;
164d3c7b9a0SKenneth D. Merry 		if ((m->subdevice != 0xffff) &&
165d3c7b9a0SKenneth D. Merry 		    (m->subdevice != pci_get_subdevice(dev)))
166d3c7b9a0SKenneth D. Merry 			continue;
167d3c7b9a0SKenneth D. Merry 		return (m);
168d3c7b9a0SKenneth D. Merry 	}
169d3c7b9a0SKenneth D. Merry 
170d3c7b9a0SKenneth D. Merry 	return (NULL);
171d3c7b9a0SKenneth D. Merry }
172d3c7b9a0SKenneth D. Merry 
173d3c7b9a0SKenneth D. Merry static int
174d3c7b9a0SKenneth D. Merry mps_pci_probe(device_t dev)
175d3c7b9a0SKenneth D. Merry {
176d3c7b9a0SKenneth D. Merry 	struct mps_ident *id;
177d3c7b9a0SKenneth D. Merry 
178d3c7b9a0SKenneth D. Merry 	if ((id = mps_find_ident(dev)) != NULL) {
179d3c7b9a0SKenneth D. Merry 		device_set_desc(dev, id->desc);
180bab89358SKenneth D. Merry 		return (BUS_PROBE_DEFAULT);
181d3c7b9a0SKenneth D. Merry 	}
182d3c7b9a0SKenneth D. Merry 	return (ENXIO);
183d3c7b9a0SKenneth D. Merry }
184d3c7b9a0SKenneth D. Merry 
185d3c7b9a0SKenneth D. Merry static int
186d3c7b9a0SKenneth D. Merry mps_pci_attach(device_t dev)
187d3c7b9a0SKenneth D. Merry {
188d3c7b9a0SKenneth D. Merry 	struct mps_softc *sc;
189d3c7b9a0SKenneth D. Merry 	struct mps_ident *m;
190d3c7b9a0SKenneth D. Merry 	int error;
191d3c7b9a0SKenneth D. Merry 
192d3c7b9a0SKenneth D. Merry 	sc = device_get_softc(dev);
193d3c7b9a0SKenneth D. Merry 	bzero(sc, sizeof(*sc));
194d3c7b9a0SKenneth D. Merry 	sc->mps_dev = dev;
195d3c7b9a0SKenneth D. Merry 	m = mps_find_ident(dev);
196d3c7b9a0SKenneth D. Merry 	sc->mps_flags = m->flags;
197d3c7b9a0SKenneth D. Merry 
198252b2b4fSScott Long 	mps_get_tunables(sc);
199252b2b4fSScott Long 
200d3c7b9a0SKenneth D. Merry 	/* Twiddle basic PCI config bits for a sanity check */
201c68534f1SScott Long 	pci_enable_busmaster(dev);
202d3c7b9a0SKenneth D. Merry 
203d3c7b9a0SKenneth D. Merry 	/* Allocate the System Interface Register Set */
204d3c7b9a0SKenneth D. Merry 	sc->mps_regs_rid = PCIR_BAR(1);
205d3c7b9a0SKenneth D. Merry 	if ((sc->mps_regs_resource = bus_alloc_resource_any(dev,
206d3c7b9a0SKenneth D. Merry 	    SYS_RES_MEMORY, &sc->mps_regs_rid, RF_ACTIVE)) == NULL) {
2071610f95cSScott Long 		mps_printf(sc, "Cannot allocate PCI registers\n");
208d3c7b9a0SKenneth D. Merry 		return (ENXIO);
209d3c7b9a0SKenneth D. Merry 	}
210d3c7b9a0SKenneth D. Merry 	sc->mps_btag = rman_get_bustag(sc->mps_regs_resource);
211d3c7b9a0SKenneth D. Merry 	sc->mps_bhandle = rman_get_bushandle(sc->mps_regs_resource);
212d3c7b9a0SKenneth D. Merry 
213d3c7b9a0SKenneth D. Merry 	/* Allocate the parent DMA tag */
214d043c564SKenneth D. Merry 	if (bus_dma_tag_create( bus_get_dma_tag(dev),	/* parent */
215d3c7b9a0SKenneth D. Merry 				1, 0,			/* algnmnt, boundary */
216d3c7b9a0SKenneth D. Merry 				BUS_SPACE_MAXADDR,	/* lowaddr */
217d3c7b9a0SKenneth D. Merry 				BUS_SPACE_MAXADDR,	/* highaddr */
218d3c7b9a0SKenneth D. Merry 				NULL, NULL,		/* filter, filterarg */
219d3c7b9a0SKenneth D. Merry 				BUS_SPACE_MAXSIZE_32BIT,/* maxsize */
220d3c7b9a0SKenneth D. Merry 				BUS_SPACE_UNRESTRICTED,	/* nsegments */
221d3c7b9a0SKenneth D. Merry 				BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */
222d3c7b9a0SKenneth D. Merry 				0,			/* flags */
223d3c7b9a0SKenneth D. Merry 				NULL, NULL,		/* lockfunc, lockarg */
224d3c7b9a0SKenneth D. Merry 				&sc->mps_parent_dmat)) {
2251610f95cSScott Long 		mps_printf(sc, "Cannot allocate parent DMA tag\n");
226d3c7b9a0SKenneth D. Merry 		mps_pci_free(sc);
227d3c7b9a0SKenneth D. Merry 		return (ENOMEM);
228d3c7b9a0SKenneth D. Merry 	}
229d3c7b9a0SKenneth D. Merry 
230252b2b4fSScott Long 	if (((error = mps_pci_alloc_interrupts(sc)) != 0) ||
231252b2b4fSScott Long 	    ((error = mps_attach(sc)) != 0))
232d3c7b9a0SKenneth D. Merry 		mps_pci_free(sc);
233d3c7b9a0SKenneth D. Merry 
234d3c7b9a0SKenneth D. Merry 	return (error);
235d3c7b9a0SKenneth D. Merry }
236d3c7b9a0SKenneth D. Merry 
237252b2b4fSScott Long /*
238252b2b4fSScott Long  * Allocate, but don't assign interrupts early.  Doing it before requesting
239252b2b4fSScott Long  * the IOCFacts message informs the firmware that we want to do MSI-X
240252b2b4fSScott Long  * multiqueue.  We might not use all of the available messages, but there's
241252b2b4fSScott Long  * no reason to re-alloc if we don't.
242252b2b4fSScott Long  */
243252b2b4fSScott Long static int
244252b2b4fSScott Long mps_pci_alloc_interrupts(struct mps_softc *sc)
245252b2b4fSScott Long {
246252b2b4fSScott Long 	device_t dev;
247252b2b4fSScott Long 	int error, msgs;
248252b2b4fSScott Long 
249252b2b4fSScott Long 	dev = sc->mps_dev;
250252b2b4fSScott Long 	error = 0;
2512068b2aaSScott Long 	msgs = 0;
252252b2b4fSScott Long 
2533c5ac992SScott Long 	if (sc->disable_msix == 0) {
2543c5ac992SScott Long 		msgs = pci_msix_count(dev);
2553c5ac992SScott Long 		mps_dprint(sc, MPS_INIT, "Counted %d MSI-X messages\n", msgs);
2563c5ac992SScott Long 		msgs = min(msgs, sc->max_msix);
2573c5ac992SScott Long 		msgs = min(msgs, MPS_MSIX_MAX);
2583c5ac992SScott Long 		msgs = min(msgs, 1);	/* XXX */
2593c5ac992SScott Long 		if (msgs != 0) {
2607eed4c18SScott Long 			mps_dprint(sc, MPS_INIT, "Attempting to allocate %d "
2617eed4c18SScott Long 			    "MSI-X messages\n", msgs);
2623c5ac992SScott Long 			error = mps_alloc_msix(sc, msgs);
2633c5ac992SScott Long 		}
2643c5ac992SScott Long 	}
2653c5ac992SScott Long 	if (((error != 0) || (msgs == 0)) && (sc->disable_msi == 0)) {
2663c5ac992SScott Long 		msgs = pci_msi_count(dev);
2673c5ac992SScott Long 		mps_dprint(sc, MPS_INIT, "Counted %d MSI messages\n", msgs);
2683c5ac992SScott Long 		msgs = min(msgs, MPS_MSI_MAX);
2693c5ac992SScott Long 		if (msgs != 0) {
2707eed4c18SScott Long 			mps_dprint(sc, MPS_INIT, "Attempting to allocate %d "
2717eed4c18SScott Long 			    "MSI messages\n", MPS_MSI_MAX);
2723c5ac992SScott Long 			error = mps_alloc_msi(sc, MPS_MSI_MAX);
2733c5ac992SScott Long 		}
2743c5ac992SScott Long 	}
2753c5ac992SScott Long 	if ((error != 0) || (msgs == 0)) {
2763d96cd78SScott Long 		/*
2773d96cd78SScott Long 		 * If neither MSI or MSI-X are avaiable, assume legacy INTx.
2783d96cd78SScott Long 		 * This also implies that there will be only 1 queue.
2793d96cd78SScott Long 		 */
2803c5ac992SScott Long 		mps_dprint(sc, MPS_INIT, "Falling back to legacy INTx\n");
2813d96cd78SScott Long 		sc->mps_flags |= MPS_FLAGS_INTX;
2823d96cd78SScott Long 		msgs = 1;
2833c5ac992SScott Long 	} else
2843d96cd78SScott Long 		sc->mps_flags |= MPS_FLAGS_MSI;
285252b2b4fSScott Long 
286252b2b4fSScott Long 	sc->msi_msgs = msgs;
2873d96cd78SScott Long 	mps_dprint(sc, MPS_INIT, "Allocated %d interrupts\n", msgs);
2883d96cd78SScott Long 
289252b2b4fSScott Long 	return (error);
290252b2b4fSScott Long }
291252b2b4fSScott Long 
292d3c7b9a0SKenneth D. Merry int
293d3c7b9a0SKenneth D. Merry mps_pci_setup_interrupts(struct mps_softc *sc)
294d3c7b9a0SKenneth D. Merry {
295d3c7b9a0SKenneth D. Merry 	device_t dev;
296bec09074SScott Long 	struct mps_queue *q;
2973d96cd78SScott Long 	void *ihandler;
2983d96cd78SScott Long 	int i, error, rid, initial_rid;
299d3c7b9a0SKenneth D. Merry 
300d3c7b9a0SKenneth D. Merry 	dev = sc->mps_dev;
301d3c7b9a0SKenneth D. Merry 	error = ENXIO;
302d3c7b9a0SKenneth D. Merry 
3033d96cd78SScott Long 	if (sc->mps_flags & MPS_FLAGS_INTX) {
3043d96cd78SScott Long 		initial_rid = 0;
3053d96cd78SScott Long 		ihandler = mps_intr;
3063d96cd78SScott Long 	} else if (sc->mps_flags & MPS_FLAGS_MSI) {
3073d96cd78SScott Long 		initial_rid = 1;
3083d96cd78SScott Long 		ihandler = mps_intr_msi;
309d3c7b9a0SKenneth D. Merry 	} else {
3103d96cd78SScott Long 		mps_dprint(sc, MPS_ERROR|MPS_INIT,
3113d96cd78SScott Long 		    "Unable to set up interrupts\n");
3123d96cd78SScott Long 		return (EINVAL);
3133d96cd78SScott Long 	}
3143d96cd78SScott Long 
3153d96cd78SScott Long 	for (i = 0; i < sc->msi_msgs; i++) {
316bec09074SScott Long 		q = &sc->queues[i];
3173d96cd78SScott Long 		rid = i + initial_rid;
318bec09074SScott Long 		q->irq_rid = rid;
319bec09074SScott Long 		q->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
320bec09074SScott Long 		    &q->irq_rid, RF_ACTIVE);
321bec09074SScott Long 		if (q->irq == NULL) {
3223d96cd78SScott Long 			mps_dprint(sc, MPS_ERROR|MPS_INIT,
3233d96cd78SScott Long 			    "Cannot allocate interrupt RID %d\n", rid);
3243c5ac992SScott Long 			sc->msi_msgs = i;
3253d96cd78SScott Long 			break;
326d3c7b9a0SKenneth D. Merry 		}
327bec09074SScott Long 		error = bus_setup_intr(dev, q->irq,
3283d96cd78SScott Long 		    INTR_TYPE_BIO | INTR_MPSAFE, NULL, ihandler,
329bec09074SScott Long 		    sc, &q->intrhand);
330d3c7b9a0SKenneth D. Merry 		if (error) {
3313d96cd78SScott Long 			mps_dprint(sc, MPS_ERROR|MPS_INIT,
3323d96cd78SScott Long 			    "Cannot setup interrupt RID %d\n", rid);
3333c5ac992SScott Long 			sc->msi_msgs = i;
334d3c7b9a0SKenneth D. Merry 			break;
335d3c7b9a0SKenneth D. Merry 		}
336d3c7b9a0SKenneth D. Merry 	}
3373d96cd78SScott Long 
3383d96cd78SScott Long 	mps_dprint(sc, MPS_INIT, "Set up %d interrupts\n", sc->msi_msgs);
339d3c7b9a0SKenneth D. Merry 
340d3c7b9a0SKenneth D. Merry 	return (error);
341d3c7b9a0SKenneth D. Merry }
342d3c7b9a0SKenneth D. Merry 
343d3c7b9a0SKenneth D. Merry static int
344d3c7b9a0SKenneth D. Merry mps_pci_detach(device_t dev)
345d3c7b9a0SKenneth D. Merry {
346d3c7b9a0SKenneth D. Merry 	struct mps_softc *sc;
347d3c7b9a0SKenneth D. Merry 	int error;
348d3c7b9a0SKenneth D. Merry 
349d3c7b9a0SKenneth D. Merry 	sc = device_get_softc(dev);
350d3c7b9a0SKenneth D. Merry 
351d3c7b9a0SKenneth D. Merry 	if ((error = mps_free(sc)) != 0)
352d3c7b9a0SKenneth D. Merry 		return (error);
353d3c7b9a0SKenneth D. Merry 
354d3c7b9a0SKenneth D. Merry 	mps_pci_free(sc);
355d3c7b9a0SKenneth D. Merry 	return (0);
356d3c7b9a0SKenneth D. Merry }
357d3c7b9a0SKenneth D. Merry 
358bec09074SScott Long void
359bec09074SScott Long mps_pci_free_interrupts(struct mps_softc *sc)
360bec09074SScott Long {
361bec09074SScott Long 	struct mps_queue *q;
362bec09074SScott Long 	int i;
363bec09074SScott Long 
364bec09074SScott Long 	if (sc->queues == NULL)
365bec09074SScott Long 		return;
366bec09074SScott Long 
367bec09074SScott Long 	for (i = 0; i < sc->msi_msgs; i++) {
368bec09074SScott Long 		q = &sc->queues[i];
369bec09074SScott Long 		if (q->irq != NULL) {
370bec09074SScott Long 			bus_teardown_intr(sc->mps_dev, q->irq,
371bec09074SScott Long 			    q->intrhand);
372bec09074SScott Long 			bus_release_resource(sc->mps_dev, SYS_RES_IRQ,
373bec09074SScott Long 			    q->irq_rid, q->irq);
374bec09074SScott Long 		}
375bec09074SScott Long 	}
376bec09074SScott Long }
377bec09074SScott Long 
378d3c7b9a0SKenneth D. Merry static void
379d3c7b9a0SKenneth D. Merry mps_pci_free(struct mps_softc *sc)
380d3c7b9a0SKenneth D. Merry {
381d3c7b9a0SKenneth D. Merry 
382d3c7b9a0SKenneth D. Merry 	if (sc->mps_parent_dmat != NULL) {
383d3c7b9a0SKenneth D. Merry 		bus_dma_tag_destroy(sc->mps_parent_dmat);
384d3c7b9a0SKenneth D. Merry 	}
385d3c7b9a0SKenneth D. Merry 
386bec09074SScott Long 	mps_pci_free_interrupts(sc);
387d3c7b9a0SKenneth D. Merry 
3883d96cd78SScott Long 	if (sc->mps_flags & MPS_FLAGS_MSI)
3893d96cd78SScott Long 		pci_release_msi(sc->mps_dev);
390d3c7b9a0SKenneth D. Merry 
391d3c7b9a0SKenneth D. Merry 	if (sc->mps_regs_resource != NULL) {
392d3c7b9a0SKenneth D. Merry 		bus_release_resource(sc->mps_dev, SYS_RES_MEMORY,
393d3c7b9a0SKenneth D. Merry 		    sc->mps_regs_rid, sc->mps_regs_resource);
394d3c7b9a0SKenneth D. Merry 	}
395d3c7b9a0SKenneth D. Merry 
396d3c7b9a0SKenneth D. Merry 	return;
397d3c7b9a0SKenneth D. Merry }
398d3c7b9a0SKenneth D. Merry 
399d3c7b9a0SKenneth D. Merry static int
400d3c7b9a0SKenneth D. Merry mps_pci_suspend(device_t dev)
401d3c7b9a0SKenneth D. Merry {
402d3c7b9a0SKenneth D. Merry 	return (EINVAL);
403d3c7b9a0SKenneth D. Merry }
404d3c7b9a0SKenneth D. Merry 
405d3c7b9a0SKenneth D. Merry static int
406d3c7b9a0SKenneth D. Merry mps_pci_resume(device_t dev)
407d3c7b9a0SKenneth D. Merry {
408d3c7b9a0SKenneth D. Merry 	return (EINVAL);
409d3c7b9a0SKenneth D. Merry }
410d3c7b9a0SKenneth D. Merry 
411d3c7b9a0SKenneth D. Merry static int
412d3c7b9a0SKenneth D. Merry mps_alloc_msix(struct mps_softc *sc, int msgs)
413d3c7b9a0SKenneth D. Merry {
414d3c7b9a0SKenneth D. Merry 	int error;
415d3c7b9a0SKenneth D. Merry 
416d3c7b9a0SKenneth D. Merry 	error = pci_alloc_msix(sc->mps_dev, &msgs);
417d3c7b9a0SKenneth D. Merry 	return (error);
418d3c7b9a0SKenneth D. Merry }
419d3c7b9a0SKenneth D. Merry 
420d3c7b9a0SKenneth D. Merry static int
421d3c7b9a0SKenneth D. Merry mps_alloc_msi(struct mps_softc *sc, int msgs)
422d3c7b9a0SKenneth D. Merry {
423d3c7b9a0SKenneth D. Merry 	int error;
424d3c7b9a0SKenneth D. Merry 
425d3c7b9a0SKenneth D. Merry 	error = pci_alloc_msi(sc->mps_dev, &msgs);
426d3c7b9a0SKenneth D. Merry 	return (error);
427d3c7b9a0SKenneth D. Merry }
428d3c7b9a0SKenneth D. Merry 
429d043c564SKenneth D. Merry int
430d043c564SKenneth D. Merry mps_pci_restore(struct mps_softc *sc)
431d043c564SKenneth D. Merry {
432d043c564SKenneth D. Merry 	struct pci_devinfo *dinfo;
433d043c564SKenneth D. Merry 
434d043c564SKenneth D. Merry 	mps_dprint(sc, MPS_TRACE, "%s\n", __func__);
435d043c564SKenneth D. Merry 
436d043c564SKenneth D. Merry 	dinfo = device_get_ivars(sc->mps_dev);
437d043c564SKenneth D. Merry 	if (dinfo == NULL) {
438d043c564SKenneth D. Merry 		mps_dprint(sc, MPS_FAULT, "%s: NULL dinfo\n", __func__);
439d043c564SKenneth D. Merry 		return (EINVAL);
440d043c564SKenneth D. Merry 	}
441d043c564SKenneth D. Merry 
442d043c564SKenneth D. Merry 	pci_cfg_restore(sc->mps_dev, dinfo);
443d043c564SKenneth D. Merry 	return (0);
444d043c564SKenneth D. Merry }
445d043c564SKenneth D. Merry 
446