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