xref: /dflybsd-src/sys/dev/raid/mpr/mpr_pci.c (revision 030b0c8c4cf27c560ccec70410c8e21934ae677d)
1fd501800SSascha Wildner /*-
2fd501800SSascha Wildner  * Copyright (c) 2009 Yahoo! Inc.
3fd501800SSascha Wildner  * All rights reserved.
4fd501800SSascha Wildner  *
5fd501800SSascha Wildner  * Redistribution and use in source and binary forms, with or without
6fd501800SSascha Wildner  * modification, are permitted provided that the following conditions
7fd501800SSascha Wildner  * are met:
8fd501800SSascha Wildner  * 1. Redistributions of source code must retain the above copyright
9fd501800SSascha Wildner  *    notice, this list of conditions and the following disclaimer.
10fd501800SSascha Wildner  * 2. Redistributions in binary form must reproduce the above copyright
11fd501800SSascha Wildner  *    notice, this list of conditions and the following disclaimer in the
12fd501800SSascha Wildner  *    documentation and/or other materials provided with the distribution.
13fd501800SSascha Wildner  *
14fd501800SSascha Wildner  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15fd501800SSascha Wildner  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16fd501800SSascha Wildner  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17fd501800SSascha Wildner  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18fd501800SSascha Wildner  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19fd501800SSascha Wildner  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20fd501800SSascha Wildner  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21fd501800SSascha Wildner  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22fd501800SSascha Wildner  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23fd501800SSascha Wildner  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24fd501800SSascha Wildner  * SUCH DAMAGE.
25fd501800SSascha Wildner  *
26fd501800SSascha Wildner  * $FreeBSD: head/sys/dev/mpr/mpr_pci.c 323629 2017-09-15 20:58:52Z scottl $
27fd501800SSascha Wildner  */
28fd501800SSascha Wildner 
29fd501800SSascha Wildner /* PCI/PCI-X/PCIe bus interface for the Avago Tech (LSI) MPT3 controllers */
30fd501800SSascha Wildner 
31fd501800SSascha Wildner /* TODO Move headers to mprvar */
32fd501800SSascha Wildner #include <sys/types.h>
33fd501800SSascha Wildner #include <sys/param.h>
34fd501800SSascha Wildner #include <sys/systm.h>
35fd501800SSascha Wildner #include <sys/kernel.h>
36fd501800SSascha Wildner #include <sys/module.h>
37fd501800SSascha Wildner #include <sys/bus.h>
38fd501800SSascha Wildner #include <sys/conf.h>
39fd501800SSascha Wildner #include <sys/malloc.h>
40fd501800SSascha Wildner #include <sys/sysctl.h>
41fd501800SSascha Wildner #include <sys/uio.h>
42fd501800SSascha Wildner #include <sys/eventhandler.h>
43fd501800SSascha Wildner 
44fd501800SSascha Wildner #include <sys/rman.h>
45fd501800SSascha Wildner 
46fd501800SSascha Wildner #include <bus/pci/pcireg.h>
47fd501800SSascha Wildner #include <bus/pci/pcivar.h>
48fd501800SSascha Wildner #include <bus/pci/pci_private.h>
49fd501800SSascha Wildner 
50fd501800SSascha Wildner #include <dev/raid/mpr/mpi/mpi2_type.h>
51fd501800SSascha Wildner #include <dev/raid/mpr/mpi/mpi2.h>
52fd501800SSascha Wildner #include <dev/raid/mpr/mpi/mpi2_ioc.h>
53fd501800SSascha Wildner #include <dev/raid/mpr/mpi/mpi2_cnfg.h>
54fd501800SSascha Wildner #include <dev/raid/mpr/mpi/mpi2_tool.h>
55fd501800SSascha Wildner #include <dev/raid/mpr/mpi/mpi2_pci.h>
56fd501800SSascha Wildner 
57fd501800SSascha Wildner #include <sys/queue.h>
58fd501800SSascha Wildner #include <sys/kthread.h>
59fd501800SSascha Wildner #include <dev/raid/mpr/mpr_ioctl.h>
60fd501800SSascha Wildner #include <dev/raid/mpr/mprvar.h>
61fd501800SSascha Wildner 
62fd501800SSascha Wildner static int	mpr_pci_probe(device_t);
63fd501800SSascha Wildner static int	mpr_pci_attach(device_t);
64fd501800SSascha Wildner static int	mpr_pci_detach(device_t);
65fd501800SSascha Wildner static int	mpr_pci_suspend(device_t);
66fd501800SSascha Wildner static int	mpr_pci_resume(device_t);
67fd501800SSascha Wildner static void	mpr_pci_free(struct mpr_softc *);
68fd501800SSascha Wildner static int	mpr_pci_alloc_interrupts(struct mpr_softc *sc);
69fd501800SSascha Wildner 
70fd501800SSascha Wildner static device_method_t mpr_methods[] = {
71fd501800SSascha Wildner 	DEVMETHOD(device_probe,		mpr_pci_probe),
72fd501800SSascha Wildner 	DEVMETHOD(device_attach,	mpr_pci_attach),
73fd501800SSascha Wildner 	DEVMETHOD(device_detach,	mpr_pci_detach),
74fd501800SSascha Wildner 	DEVMETHOD(device_suspend,	mpr_pci_suspend),
75fd501800SSascha Wildner 	DEVMETHOD(device_resume,	mpr_pci_resume),
76fd501800SSascha Wildner 	DEVMETHOD(bus_print_child,	bus_generic_print_child),
77fd501800SSascha Wildner 	DEVMETHOD(bus_driver_added,	bus_generic_driver_added),
78fd501800SSascha Wildner 	{ 0, 0 }
79fd501800SSascha Wildner };
80fd501800SSascha Wildner 
81fd501800SSascha Wildner static driver_t mpr_pci_driver = {
82fd501800SSascha Wildner 	"mpr",
83fd501800SSascha Wildner 	mpr_methods,
84fd501800SSascha Wildner 	sizeof(struct mpr_softc)
85fd501800SSascha Wildner };
86fd501800SSascha Wildner 
87fd501800SSascha Wildner static devclass_t	mpr_devclass;
88*17975de1SSascha Wildner DRIVER_MODULE(mpr, pci, mpr_pci_driver, mpr_devclass, NULL, NULL);
89fd501800SSascha Wildner MODULE_DEPEND(mpr, cam, 1, 1, 1);
90fd501800SSascha Wildner 
91fd501800SSascha Wildner struct mpr_ident {
92fd501800SSascha Wildner 	uint16_t	vendor;
93fd501800SSascha Wildner 	uint16_t	device;
94fd501800SSascha Wildner 	uint16_t	subvendor;
95fd501800SSascha Wildner 	uint16_t	subdevice;
96fd501800SSascha Wildner 	u_int		flags;
97fd501800SSascha Wildner 	const char	*desc;
98fd501800SSascha Wildner } mpr_identifiers[] = {
99fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3004,
100fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3004" },
101fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3008,
102fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3008" },
103fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_1,
104fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3108_1" },
105fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_2,
106fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3108_2" },
107fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_5,
108fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3108_5" },
109fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_6,
110fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3108_6" },
111fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3216,
112fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3216" },
113fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3224,
114fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3224" },
115fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3316_1,
116fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3316_1" },
117fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3316_2,
118fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3316_2" },
119fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3324_1,
120fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3324_1" },
121fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3324_2,
122fd501800SSascha Wildner 	    0xffff, 0xffff, 0, "Avago Technologies (LSI) SAS3324_2" },
123fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3408,
124fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
125fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3408" },
126fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3416,
127fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
128fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3416" },
129fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3508,
130fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
131fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3508" },
132fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3508_1,
133fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
134fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3508_1" },
135fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3516,
136fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
137fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3516" },
138fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3516_1,
139fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
140fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3516_1" },
141fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3616,
142fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
143fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3616" },
144fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3708,
145fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
146fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3708" },
147fd501800SSascha Wildner 	{ MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3716,
148fd501800SSascha Wildner 	    0xffff, 0xffff, MPR_FLAGS_GEN35_IOC,
149fd501800SSascha Wildner 	    "Avago Technologies (LSI) SAS3716" },
150fd501800SSascha Wildner 	{ 0, 0, 0, 0, 0, NULL }
151fd501800SSascha Wildner };
152fd501800SSascha Wildner 
153fd501800SSascha Wildner static struct mpr_ident *
mpr_find_ident(device_t dev)154fd501800SSascha Wildner mpr_find_ident(device_t dev)
155fd501800SSascha Wildner {
156fd501800SSascha Wildner 	struct mpr_ident *m;
157fd501800SSascha Wildner 
158fd501800SSascha Wildner 	for (m = mpr_identifiers; m->vendor != 0; m++) {
159fd501800SSascha Wildner 		if (m->vendor != pci_get_vendor(dev))
160fd501800SSascha Wildner 			continue;
161fd501800SSascha Wildner 		if (m->device != pci_get_device(dev))
162fd501800SSascha Wildner 			continue;
163fd501800SSascha Wildner 		if ((m->subvendor != 0xffff) &&
164fd501800SSascha Wildner 		    (m->subvendor != pci_get_subvendor(dev)))
165fd501800SSascha Wildner 			continue;
166fd501800SSascha Wildner 		if ((m->subdevice != 0xffff) &&
167fd501800SSascha Wildner 		    (m->subdevice != pci_get_subdevice(dev)))
168fd501800SSascha Wildner 			continue;
169fd501800SSascha Wildner 		return (m);
170fd501800SSascha Wildner 	}
171fd501800SSascha Wildner 
172fd501800SSascha Wildner 	return (NULL);
173fd501800SSascha Wildner }
174fd501800SSascha Wildner 
175fd501800SSascha Wildner static int
mpr_pci_probe(device_t dev)176fd501800SSascha Wildner mpr_pci_probe(device_t dev)
177fd501800SSascha Wildner {
178fd501800SSascha Wildner 	struct mpr_ident *id;
179fd501800SSascha Wildner 
180fd501800SSascha Wildner 	if ((id = mpr_find_ident(dev)) != NULL) {
181fd501800SSascha Wildner 		device_set_desc(dev, id->desc);
182fd501800SSascha Wildner 		return (BUS_PROBE_DEFAULT);
183fd501800SSascha Wildner 	}
184fd501800SSascha Wildner 	return (ENXIO);
185fd501800SSascha Wildner }
186fd501800SSascha Wildner 
187fd501800SSascha Wildner static int
mpr_pci_attach(device_t dev)188fd501800SSascha Wildner mpr_pci_attach(device_t dev)
189fd501800SSascha Wildner {
190fd501800SSascha Wildner 	struct mpr_softc *sc;
191fd501800SSascha Wildner 	struct mpr_ident *m;
192fd501800SSascha Wildner 	int error, i;
193fd501800SSascha Wildner 
194fd501800SSascha Wildner 	sc = device_get_softc(dev);
195fd501800SSascha Wildner 	bzero(sc, sizeof(*sc));
196fd501800SSascha Wildner 	sc->mpr_dev = dev;
197fd501800SSascha Wildner 	m = mpr_find_ident(dev);
198fd501800SSascha Wildner 	sc->mpr_flags = m->flags;
199fd501800SSascha Wildner 
200fd501800SSascha Wildner 	mpr_get_tunables(sc);
201fd501800SSascha Wildner 
202fd501800SSascha Wildner 	/* Twiddle basic PCI config bits for a sanity check */
203fd501800SSascha Wildner 	pci_enable_busmaster(dev);
204fd501800SSascha Wildner 
205fd501800SSascha Wildner 	for (i = 0; i < PCI_MAXMAPS_0; i++) {
206fd501800SSascha Wildner 		sc->mpr_regs_rid = PCIR_BAR(i);
207fd501800SSascha Wildner 
208fd501800SSascha Wildner 		if ((sc->mpr_regs_resource = bus_alloc_resource_any(dev,
209fd501800SSascha Wildner 		    SYS_RES_MEMORY, &sc->mpr_regs_rid, RF_ACTIVE)) != NULL)
210fd501800SSascha Wildner 			break;
211fd501800SSascha Wildner 	}
212fd501800SSascha Wildner 
213fd501800SSascha Wildner 	if (sc->mpr_regs_resource == NULL) {
214fd501800SSascha Wildner 		mpr_printf(sc, "Cannot allocate PCI registers\n");
215fd501800SSascha Wildner 		return (ENXIO);
216fd501800SSascha Wildner 	}
217fd501800SSascha Wildner 
218fd501800SSascha Wildner 	sc->mpr_btag = rman_get_bustag(sc->mpr_regs_resource);
219fd501800SSascha Wildner 	sc->mpr_bhandle = rman_get_bushandle(sc->mpr_regs_resource);
220fd501800SSascha Wildner 
221fd501800SSascha Wildner 	/* Allocate the parent DMA tag */
222fd501800SSascha Wildner 	if (bus_dma_tag_create( bus_get_dma_tag(dev),	/* parent */
223fd501800SSascha Wildner 				1, 0,			/* algnmnt, boundary */
224fd501800SSascha Wildner 				BUS_SPACE_MAXADDR,	/* lowaddr */
225fd501800SSascha Wildner 				BUS_SPACE_MAXADDR,	/* highaddr */
226fd501800SSascha Wildner 				BUS_SPACE_MAXSIZE_32BIT,/* maxsize */
227fd501800SSascha Wildner 				BUS_SPACE_UNRESTRICTED,	/* nsegments */
228fd501800SSascha Wildner 				BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */
229fd501800SSascha Wildner 				0,			/* flags */
230fd501800SSascha Wildner 				&sc->mpr_parent_dmat)) {
231fd501800SSascha Wildner 		mpr_printf(sc, "Cannot allocate parent DMA tag\n");
232fd501800SSascha Wildner 		mpr_pci_free(sc);
233fd501800SSascha Wildner 		return (ENOMEM);
234fd501800SSascha Wildner 	}
235fd501800SSascha Wildner 
236fd501800SSascha Wildner 	if (((error = mpr_pci_alloc_interrupts(sc)) != 0) ||
237fd501800SSascha Wildner 	    ((error = mpr_attach(sc)) != 0))
238fd501800SSascha Wildner 		mpr_pci_free(sc);
239fd501800SSascha Wildner 
240fd501800SSascha Wildner 	return (error);
241fd501800SSascha Wildner }
242fd501800SSascha Wildner 
243fd501800SSascha Wildner /*
244fd501800SSascha Wildner  * Allocate, but don't assign interrupts early.  Doing it before requesting
245fd501800SSascha Wildner  * the IOCFacts message informs the firmware that we want to do MSI-X
246fd501800SSascha Wildner  * multiqueue.  We might not use all of the available messages, but there's
247fd501800SSascha Wildner  * no reason to re-alloc if we don't.
248fd501800SSascha Wildner  *
249fd501800SSascha Wildner  * XXX swildner: MSI-X support missing
250fd501800SSascha Wildner  */
251fd501800SSascha Wildner int
mpr_pci_alloc_interrupts(struct mpr_softc * sc)252fd501800SSascha Wildner mpr_pci_alloc_interrupts(struct mpr_softc *sc)
253fd501800SSascha Wildner {
254fd501800SSascha Wildner 	device_t dev;
255fd501800SSascha Wildner 
256fd501800SSascha Wildner 	dev = sc->mpr_dev;
257fd501800SSascha Wildner 
258fd501800SSascha Wildner 	sc->msi_msgs = 1;
259fd501800SSascha Wildner 	sc->irq_type = pci_alloc_1intr(dev, sc->msi_enable, &sc->irq_rid,
260fd501800SSascha Wildner 	    &sc->irq_flags);
261fd501800SSascha Wildner 	if (sc->irq_type == PCI_INTR_TYPE_MSI)
262fd501800SSascha Wildner 		sc->mpr_flags |= MPR_FLAGS_MSI;
263fd501800SSascha Wildner 	else
264fd501800SSascha Wildner 		sc->mpr_flags |= MPR_FLAGS_INTX;
265fd501800SSascha Wildner 
266fd501800SSascha Wildner 	return (0);
267fd501800SSascha Wildner }
268fd501800SSascha Wildner 
269fd501800SSascha Wildner int
mpr_pci_setup_interrupts(struct mpr_softc * sc)270fd501800SSascha Wildner mpr_pci_setup_interrupts(struct mpr_softc *sc)
271fd501800SSascha Wildner {
272fd501800SSascha Wildner 	device_t dev;
273fd501800SSascha Wildner 	struct mpr_queue *q;
274fd501800SSascha Wildner 	void *ihandler;
275fd501800SSascha Wildner 	int i, error, rid;
276fd501800SSascha Wildner 
277fd501800SSascha Wildner 	dev = sc->mpr_dev;
278fd501800SSascha Wildner 	error = ENXIO;
279fd501800SSascha Wildner 
280fd501800SSascha Wildner 	if (sc->mpr_flags & MPR_FLAGS_INTX) {
281fd501800SSascha Wildner 		ihandler = mpr_intr;
282fd501800SSascha Wildner 	} else if (sc->mpr_flags & MPR_FLAGS_MSI) {
283fd501800SSascha Wildner 		ihandler = mpr_intr_msi;
284fd501800SSascha Wildner 	} else {
285fd501800SSascha Wildner 		mpr_dprint(sc, MPR_ERROR|MPR_INIT,
286fd501800SSascha Wildner 		    "Unable to set up interrupts\n");
287fd501800SSascha Wildner 		return (EINVAL);
288fd501800SSascha Wildner 	}
289fd501800SSascha Wildner 
290fd501800SSascha Wildner 	for (i = 0; i < sc->msi_msgs; i++) {
291fd501800SSascha Wildner 		q = &sc->queues[i];
292fd501800SSascha Wildner 		rid = sc->irq_rid;
293fd501800SSascha Wildner 		q->irq_rid = rid;
294fd501800SSascha Wildner 		q->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
295fd501800SSascha Wildner 		    &q->irq_rid, sc->irq_flags);
296fd501800SSascha Wildner 		if (q->irq == NULL) {
297fd501800SSascha Wildner 			mpr_dprint(sc, MPR_ERROR|MPR_INIT,
298fd501800SSascha Wildner 			    "Cannot allocate interrupt RID %d\n", rid);
299fd501800SSascha Wildner 			sc->msi_msgs = i;
300fd501800SSascha Wildner 			break;
301fd501800SSascha Wildner 		}
302fd501800SSascha Wildner 		error = bus_setup_intr(dev, q->irq, INTR_MPSAFE, ihandler,
303fd501800SSascha Wildner 		    sc, &q->intrhand, NULL);
304fd501800SSascha Wildner 		if (error) {
305fd501800SSascha Wildner 			mpr_dprint(sc, MPR_ERROR|MPR_INIT,
306fd501800SSascha Wildner 			    "Cannot setup interrupt RID %d\n", rid);
307fd501800SSascha Wildner 			sc->msi_msgs = i;
308fd501800SSascha Wildner 			break;
309fd501800SSascha Wildner 		}
310fd501800SSascha Wildner 	}
311fd501800SSascha Wildner 
312fd501800SSascha Wildner         mpr_dprint(sc, MPR_INIT, "Set up %d interrupts\n", sc->msi_msgs);
313fd501800SSascha Wildner 	return (error);
314fd501800SSascha Wildner }
315fd501800SSascha Wildner 
316fd501800SSascha Wildner static int
mpr_pci_detach(device_t dev)317fd501800SSascha Wildner mpr_pci_detach(device_t dev)
318fd501800SSascha Wildner {
319fd501800SSascha Wildner 	struct mpr_softc *sc;
320fd501800SSascha Wildner 	int error;
321fd501800SSascha Wildner 
322fd501800SSascha Wildner 	sc = device_get_softc(dev);
323fd501800SSascha Wildner 
324fd501800SSascha Wildner 	if ((error = mpr_free(sc)) != 0)
325fd501800SSascha Wildner 		return (error);
326fd501800SSascha Wildner 
327fd501800SSascha Wildner 	mpr_pci_free(sc);
328fd501800SSascha Wildner 	return (0);
329fd501800SSascha Wildner }
330fd501800SSascha Wildner 
331fd501800SSascha Wildner void
mpr_pci_free_interrupts(struct mpr_softc * sc)332fd501800SSascha Wildner mpr_pci_free_interrupts(struct mpr_softc *sc)
333fd501800SSascha Wildner {
334fd501800SSascha Wildner 	struct mpr_queue *q;
335fd501800SSascha Wildner 	int i;
336fd501800SSascha Wildner 
337fd501800SSascha Wildner 	if (sc->queues == NULL)
338fd501800SSascha Wildner 		return;
339fd501800SSascha Wildner 
340fd501800SSascha Wildner 	for (i = 0; i < sc->msi_msgs; i++) {
341fd501800SSascha Wildner 		q = &sc->queues[i];
342fd501800SSascha Wildner 		if (q->irq != NULL) {
343fd501800SSascha Wildner 			bus_teardown_intr(sc->mpr_dev, q->irq,
344fd501800SSascha Wildner 			    q->intrhand);
345fd501800SSascha Wildner 			bus_release_resource(sc->mpr_dev, SYS_RES_IRQ,
346fd501800SSascha Wildner 			    q->irq_rid, q->irq);
347fd501800SSascha Wildner 		}
348fd501800SSascha Wildner 	}
349fd501800SSascha Wildner }
350fd501800SSascha Wildner 
351fd501800SSascha Wildner static void
mpr_pci_free(struct mpr_softc * sc)352fd501800SSascha Wildner mpr_pci_free(struct mpr_softc *sc)
353fd501800SSascha Wildner {
354fd501800SSascha Wildner 
355fd501800SSascha Wildner 	if (sc->mpr_parent_dmat != NULL) {
356fd501800SSascha Wildner 		bus_dma_tag_destroy(sc->mpr_parent_dmat);
357fd501800SSascha Wildner 	}
358fd501800SSascha Wildner 
359fd501800SSascha Wildner 	mpr_pci_free_interrupts(sc);
360fd501800SSascha Wildner 
361fd501800SSascha Wildner 	if (sc->mpr_flags & MPR_FLAGS_MSI)
362fd501800SSascha Wildner 		pci_release_msi(sc->mpr_dev);
363fd501800SSascha Wildner 
364fd501800SSascha Wildner 	if (sc->mpr_regs_resource != NULL) {
365fd501800SSascha Wildner 		bus_release_resource(sc->mpr_dev, SYS_RES_MEMORY,
366fd501800SSascha Wildner 		    sc->mpr_regs_rid, sc->mpr_regs_resource);
367fd501800SSascha Wildner 	}
368fd501800SSascha Wildner 
369fd501800SSascha Wildner 	return;
370fd501800SSascha Wildner }
371fd501800SSascha Wildner 
372fd501800SSascha Wildner static int
mpr_pci_suspend(device_t dev)373fd501800SSascha Wildner mpr_pci_suspend(device_t dev)
374fd501800SSascha Wildner {
375fd501800SSascha Wildner 	return (EINVAL);
376fd501800SSascha Wildner }
377fd501800SSascha Wildner 
378fd501800SSascha Wildner static int
mpr_pci_resume(device_t dev)379fd501800SSascha Wildner mpr_pci_resume(device_t dev)
380fd501800SSascha Wildner {
381fd501800SSascha Wildner 	return (EINVAL);
382fd501800SSascha Wildner }
383fd501800SSascha Wildner 
384fd501800SSascha Wildner int
mpr_pci_restore(struct mpr_softc * sc)385fd501800SSascha Wildner mpr_pci_restore(struct mpr_softc *sc)
386fd501800SSascha Wildner {
387fd501800SSascha Wildner 	struct pci_devinfo *dinfo;
388fd501800SSascha Wildner 
389fd501800SSascha Wildner 	mpr_dprint(sc, MPR_TRACE, "%s\n", __func__);
390fd501800SSascha Wildner 
391fd501800SSascha Wildner 	dinfo = device_get_ivars(sc->mpr_dev);
392fd501800SSascha Wildner 	if (dinfo == NULL) {
393fd501800SSascha Wildner 		mpr_dprint(sc, MPR_FAULT, "%s: NULL dinfo\n", __func__);
394fd501800SSascha Wildner 		return (EINVAL);
395fd501800SSascha Wildner 	}
396fd501800SSascha Wildner 
397fd501800SSascha Wildner 	pci_cfg_restore(sc->mpr_dev, dinfo);
398fd501800SSascha Wildner 	return (0);
399fd501800SSascha Wildner }
400fd501800SSascha Wildner 
401