xref: /freebsd/sys/powerpc/mpc85xx/pci_mpc85xx.c (revision c66ec88f)
1 /*-
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright 2006-2007 by Juniper Networks.
5  * Copyright 2008 Semihalf.
6  * Copyright 2010 The FreeBSD Foundation
7  * All rights reserved.
8  *
9  * Portions of this software were developed by Semihalf
10  * under sponsorship from the FreeBSD Foundation.
11  *
12  * Redistribution and use in source and binary forms, with or without
13  * modification, are permitted provided that the following conditions
14  * are met:
15  * 1. Redistributions of source code must retain the above copyright
16  *    notice, this list of conditions and the following disclaimer.
17  * 2. Redistributions in binary form must reproduce the above copyright
18  *    notice, this list of conditions and the following disclaimer in the
19  *    documentation and/or other materials provided with the distribution.
20  * 3. The name of the author may not be used to endorse or promote products
21  *    derived from this software without specific prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
24  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
28  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
29  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
30  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
31  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33  * SUCH DAMAGE.
34  *
35  * From: FreeBSD: src/sys/powerpc/mpc85xx/pci_ocp.c,v 1.9 2010/03/23 23:46:28 marcel
36  */
37 
38 #include <sys/cdefs.h>
39 __FBSDID("$FreeBSD$");
40 
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/ktr.h>
44 #include <sys/sockio.h>
45 #include <sys/mbuf.h>
46 #include <sys/malloc.h>
47 #include <sys/kernel.h>
48 #include <sys/module.h>
49 #include <sys/socket.h>
50 #include <sys/queue.h>
51 #include <sys/bus.h>
52 #include <sys/lock.h>
53 #include <sys/mutex.h>
54 #include <sys/queue.h>
55 #include <sys/rman.h>
56 #include <sys/endian.h>
57 #include <sys/vmem.h>
58 
59 #include <vm/vm.h>
60 #include <vm/pmap.h>
61 
62 #include <dev/ofw/ofw_pci.h>
63 #include <dev/ofw/ofw_bus.h>
64 #include <dev/ofw/ofw_bus_subr.h>
65 #include <dev/ofw/ofwpci.h>
66 #include <dev/pci/pcivar.h>
67 #include <dev/pci/pcireg.h>
68 #include <dev/pci/pcib_private.h>
69 
70 #include "ofw_bus_if.h"
71 #include "pcib_if.h"
72 #include "pic_if.h"
73 
74 #include <machine/resource.h>
75 #include <machine/bus.h>
76 #include <machine/intr_machdep.h>
77 
78 #include <powerpc/mpc85xx/mpc85xx.h>
79 
80 #define	REG_CFG_ADDR	0x0000
81 #define	CONFIG_ACCESS_ENABLE	0x80000000
82 
83 #define	REG_CFG_DATA	0x0004
84 #define	REG_INT_ACK	0x0008
85 
86 #define	REG_PEX_IP_BLK_REV1	0x0bf8
87 #define	  IP_MJ_M		  0x0000ff00
88 #define	  IP_MJ_S		  8
89 #define	  IP_MN_M		  0x000000ff
90 #define	  IP_MN_S		  0
91 
92 #define	REG_POTAR(n)	(0x0c00 + 0x20 * (n))
93 #define	REG_POTEAR(n)	(0x0c04 + 0x20 * (n))
94 #define	REG_POWBAR(n)	(0x0c08 + 0x20 * (n))
95 #define	REG_POWAR(n)	(0x0c10 + 0x20 * (n))
96 
97 #define	REG_PITAR(n)	(0x0e00 - 0x20 * (n))
98 #define	REG_PIWBAR(n)	(0x0e08 - 0x20 * (n))
99 #define	REG_PIWBEAR(n)	(0x0e0c - 0x20 * (n))
100 #define	REG_PIWAR(n)	(0x0e10 - 0x20 * (n))
101 #define	  PIWAR_EN	  0x80000000
102 #define	  PIWAR_PF	  0x40000000
103 #define	  PIWAR_TRGT_M	  0x00f00000
104 #define	  PIWAR_TRGT_S	  20
105 #define	  PIWAR_TRGT_CCSR	  0xe
106 #define	  PIWAR_TRGT_LOCAL	  0xf
107 
108 #define	REG_PEX_MES_DR	0x0020
109 #define	REG_PEX_MES_IER	0x0028
110 #define	REG_PEX_ERR_DR	0x0e00
111 #define	REG_PEX_ERR_EN	0x0e08
112 
113 #define	REG_PEX_ERR_DR		0x0e00
114 #define	REG_PEX_ERR_DR_ME	0x80000000
115 #define	REG_PEX_ERR_DR_PCT	0x800000
116 #define	REG_PEX_ERR_DR_PAT	0x400000
117 #define	REG_PEX_ERR_DR_PCAC	0x200000
118 #define	REG_PEX_ERR_DR_PNM	0x100000
119 #define	REG_PEX_ERR_DR_CDNSC	0x80000
120 #define	REG_PEX_ERR_DR_CRSNC	0x40000
121 #define	REG_PEX_ERR_DR_ICCA	0x20000
122 #define	REG_PEX_ERR_DR_IACA	0x10000
123 #define	REG_PEX_ERR_DR_CRST	0x8000
124 #define	REG_PEX_ERR_DR_MIS	0x4000
125 #define	REG_PEX_ERR_DR_IOIS	0x2000
126 #define	REG_PEX_ERR_DR_CIS	0x1000
127 #define	REG_PEX_ERR_DR_CIEP	0x800
128 #define	REG_PEX_ERR_DR_IOIEP	0x400
129 #define	REG_PEX_ERR_DR_OAC	0x200
130 #define	REG_PEX_ERR_DR_IOIA	0x100
131 #define	REG_PEX_ERR_DR_IMBA	0x80
132 #define	REG_PEX_ERR_DR_IIOBA	0x40
133 #define	REG_PEX_ERR_DR_LDDE	0x20
134 #define	REG_PEX_ERR_EN		0x0e08
135 
136 #define PCIR_LTSSM	0x404
137 #define LTSSM_STAT_L0	0x16
138 
139 #define	DEVFN(b, s, f)	((b << 16) | (s << 8) | f)
140 
141 #define	FSL_NUM_MSIS		256	/* 8 registers of 32 bits (8 hardware IRQs) */
142 
143 struct fsl_pcib_softc {
144 	struct ofw_pci_softc pci_sc;
145 	device_t	sc_dev;
146 	struct mtx	sc_cfg_mtx;
147 	int		sc_ip_maj;
148 	int		sc_ip_min;
149 
150 	int		sc_iomem_target;
151 	bus_addr_t	sc_iomem_start, sc_iomem_end;
152 	int		sc_ioport_target;
153 	bus_addr_t	sc_ioport_start, sc_ioport_end;
154 
155 	struct resource *sc_res;
156 	bus_space_handle_t sc_bsh;
157 	bus_space_tag_t	sc_bst;
158 	int		sc_rid;
159 
160 	struct resource	*sc_irq_res;
161 	void		*sc_ih;
162 
163 	int		sc_busnr;
164 	int		sc_pcie;
165 	uint8_t		sc_pcie_capreg;		/* PCI-E Capability Reg Set */
166 };
167 
168 struct fsl_pcib_err_dr {
169 	const char	*msg;
170 	uint32_t	err_dr_mask;
171 };
172 
173 struct fsl_msi_map {
174 	SLIST_ENTRY(fsl_msi_map) slist;
175 	uint32_t	irq_base;
176 	bus_addr_t	target;
177 };
178 
179 SLIST_HEAD(msi_head, fsl_msi_map) fsl_msis = SLIST_HEAD_INITIALIZER(msi_head);
180 
181 static const struct fsl_pcib_err_dr pci_err[] = {
182 	{"ME",		REG_PEX_ERR_DR_ME},
183 	{"PCT",		REG_PEX_ERR_DR_PCT},
184 	{"PAT",		REG_PEX_ERR_DR_PAT},
185 	{"PCAC",	REG_PEX_ERR_DR_PCAC},
186 	{"PNM",		REG_PEX_ERR_DR_PNM},
187 	{"CDNSC",	REG_PEX_ERR_DR_CDNSC},
188 	{"CRSNC",	REG_PEX_ERR_DR_CRSNC},
189 	{"ICCA",	REG_PEX_ERR_DR_ICCA},
190 	{"IACA",	REG_PEX_ERR_DR_IACA},
191 	{"CRST",	REG_PEX_ERR_DR_CRST},
192 	{"MIS",		REG_PEX_ERR_DR_MIS},
193 	{"IOIS",	REG_PEX_ERR_DR_IOIS},
194 	{"CIS",		REG_PEX_ERR_DR_CIS},
195 	{"CIEP",	REG_PEX_ERR_DR_CIEP},
196 	{"IOIEP",	REG_PEX_ERR_DR_IOIEP},
197 	{"OAC",		REG_PEX_ERR_DR_OAC},
198 	{"IOIA",	REG_PEX_ERR_DR_IOIA},
199 	{"IMBA",	REG_PEX_ERR_DR_IMBA},
200 	{"IIOBA",	REG_PEX_ERR_DR_IIOBA},
201 	{"LDDE",	REG_PEX_ERR_DR_LDDE}
202 };
203 
204 /* Local forward declerations. */
205 static uint32_t fsl_pcib_cfgread(struct fsl_pcib_softc *, u_int, u_int, u_int,
206     u_int, int);
207 static void fsl_pcib_cfgwrite(struct fsl_pcib_softc *, u_int, u_int, u_int,
208     u_int, uint32_t, int);
209 static int fsl_pcib_decode_win(phandle_t, struct fsl_pcib_softc *);
210 static void fsl_pcib_err_init(device_t);
211 static void fsl_pcib_inbound(struct fsl_pcib_softc *, int, int, uint64_t,
212     uint64_t, uint64_t);
213 static void fsl_pcib_outbound(struct fsl_pcib_softc *, int, int, uint64_t,
214     uint64_t, uint64_t);
215 
216 /* Forward declerations. */
217 static int fsl_pcib_attach(device_t);
218 static int fsl_pcib_detach(device_t);
219 static int fsl_pcib_probe(device_t);
220 
221 static int fsl_pcib_maxslots(device_t);
222 static uint32_t fsl_pcib_read_config(device_t, u_int, u_int, u_int, u_int, int);
223 static void fsl_pcib_write_config(device_t, u_int, u_int, u_int, u_int,
224     uint32_t, int);
225 static int fsl_pcib_alloc_msi(device_t dev, device_t child,
226     int count, int maxcount, int *irqs);
227 static int fsl_pcib_release_msi(device_t dev, device_t child,
228     int count, int *irqs);
229 static int fsl_pcib_alloc_msix(device_t dev, device_t child, int *irq);
230 static int fsl_pcib_release_msix(device_t dev, device_t child, int irq);
231 static int fsl_pcib_map_msi(device_t dev, device_t child,
232     int irq, uint64_t *addr, uint32_t *data);
233 
234 static vmem_t *msi_vmem;	/* Global MSI vmem, holds all MSI ranges. */
235 
236 /*
237  * Bus interface definitions.
238  */
239 static device_method_t fsl_pcib_methods[] = {
240 	/* Device interface */
241 	DEVMETHOD(device_probe,		fsl_pcib_probe),
242 	DEVMETHOD(device_attach,	fsl_pcib_attach),
243 	DEVMETHOD(device_detach,	fsl_pcib_detach),
244 
245 	/* pcib interface */
246 	DEVMETHOD(pcib_maxslots,	fsl_pcib_maxslots),
247 	DEVMETHOD(pcib_read_config,	fsl_pcib_read_config),
248 	DEVMETHOD(pcib_write_config,	fsl_pcib_write_config),
249 	DEVMETHOD(pcib_alloc_msi,	fsl_pcib_alloc_msi),
250 	DEVMETHOD(pcib_release_msi,	fsl_pcib_release_msi),
251 	DEVMETHOD(pcib_alloc_msix,	fsl_pcib_alloc_msix),
252 	DEVMETHOD(pcib_release_msix,	fsl_pcib_release_msix),
253 	DEVMETHOD(pcib_map_msi,		fsl_pcib_map_msi),
254 
255 	DEVMETHOD_END
256 };
257 
258 static devclass_t fsl_pcib_devclass;
259 
260 DEFINE_CLASS_1(pcib, fsl_pcib_driver, fsl_pcib_methods,
261     sizeof(struct fsl_pcib_softc), ofw_pci_driver);
262 EARLY_DRIVER_MODULE(pcib, ofwbus, fsl_pcib_driver, fsl_pcib_devclass, 0, 0,
263     BUS_PASS_BUS);
264 
265 static void
266 fsl_pcib_err_intr(void *v)
267 {
268 	struct fsl_pcib_softc *sc;
269 	device_t dev;
270 	uint32_t err_reg, clear_reg;
271 	uint8_t i;
272 
273 	dev = (device_t)v;
274 	sc = device_get_softc(dev);
275 
276 	clear_reg = 0;
277 	err_reg = bus_space_read_4(sc->sc_bst, sc->sc_bsh, REG_PEX_ERR_DR);
278 
279 	/* Check which one error occurred */
280 	for (i = 0; i < sizeof(pci_err)/sizeof(struct fsl_pcib_err_dr); i++) {
281 		if (err_reg & pci_err[i].err_dr_mask) {
282 			device_printf(dev, "PCI %d: report %s error\n",
283 			    device_get_unit(dev), pci_err[i].msg);
284 			clear_reg |= pci_err[i].err_dr_mask;
285 		}
286 	}
287 
288 	/* Clear pending errors */
289 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PEX_ERR_DR, clear_reg);
290 }
291 
292 static int
293 fsl_pcib_probe(device_t dev)
294 {
295 
296 	if (ofw_bus_get_type(dev) == NULL ||
297 	    strcmp(ofw_bus_get_type(dev), "pci") != 0)
298 		return (ENXIO);
299 
300 	if (!(ofw_bus_is_compatible(dev, "fsl,mpc8540-pci") ||
301 	    ofw_bus_is_compatible(dev, "fsl,mpc8540-pcie") ||
302 	    ofw_bus_is_compatible(dev, "fsl,mpc8548-pcie") ||
303 	    ofw_bus_is_compatible(dev, "fsl,p5020-pcie") ||
304 	    ofw_bus_is_compatible(dev, "fsl,qoriq-pcie-v2.2") ||
305 	    ofw_bus_is_compatible(dev, "fsl,qoriq-pcie")))
306 		return (ENXIO);
307 
308 	device_set_desc(dev, "Freescale Integrated PCI/PCI-E Controller");
309 	return (BUS_PROBE_DEFAULT);
310 }
311 
312 static int
313 fsl_pcib_attach(device_t dev)
314 {
315 	struct fsl_pcib_softc *sc;
316 	phandle_t node;
317 	uint32_t cfgreg, brctl, ipreg;
318 	int error, rid;
319 	uint8_t ltssm, capptr;
320 
321 	sc = device_get_softc(dev);
322 	sc->sc_dev = dev;
323 
324 	sc->sc_rid = 0;
325 	sc->sc_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_rid,
326 	    RF_ACTIVE);
327 	if (sc->sc_res == NULL) {
328 		device_printf(dev, "could not map I/O memory\n");
329 		return (ENXIO);
330 	}
331 	sc->sc_bst = rman_get_bustag(sc->sc_res);
332 	sc->sc_bsh = rman_get_bushandle(sc->sc_res);
333 	sc->sc_busnr = 0;
334 
335 	ipreg = bus_read_4(sc->sc_res, REG_PEX_IP_BLK_REV1);
336 	sc->sc_ip_min = (ipreg & IP_MN_M) >> IP_MN_S;
337 	sc->sc_ip_maj = (ipreg & IP_MJ_M) >> IP_MJ_S;
338 	mtx_init(&sc->sc_cfg_mtx, "pcicfg", NULL, MTX_SPIN);
339 
340 	cfgreg = fsl_pcib_cfgread(sc, 0, 0, 0, PCIR_VENDOR, 2);
341 	if (cfgreg != 0x1057 && cfgreg != 0x1957)
342 		goto err;
343 
344 	capptr = fsl_pcib_cfgread(sc, 0, 0, 0, PCIR_CAP_PTR, 1);
345 	while (capptr != 0) {
346 		cfgreg = fsl_pcib_cfgread(sc, 0, 0, 0, capptr, 2);
347 		switch (cfgreg & 0xff) {
348 		case PCIY_PCIX:
349 			break;
350 		case PCIY_EXPRESS:
351 			sc->sc_pcie = 1;
352 			sc->sc_pcie_capreg = capptr;
353 			break;
354 		}
355 		capptr = (cfgreg >> 8) & 0xff;
356 	}
357 
358 	node = ofw_bus_get_node(dev);
359 
360 	/*
361 	 * Initialize generic OF PCI interface (ranges, etc.)
362 	 */
363 
364 	error = ofw_pci_init(dev);
365 	if (error)
366 		return (error);
367 
368 	/*
369 	 * Configure decode windows for PCI(E) access.
370 	 */
371 	if (fsl_pcib_decode_win(node, sc) != 0)
372 		goto err;
373 
374 	cfgreg = fsl_pcib_cfgread(sc, 0, 0, 0, PCIR_COMMAND, 2);
375 	cfgreg |= PCIM_CMD_SERRESPEN | PCIM_CMD_BUSMASTEREN | PCIM_CMD_MEMEN |
376 	    PCIM_CMD_PORTEN;
377 	fsl_pcib_cfgwrite(sc, 0, 0, 0, PCIR_COMMAND, cfgreg, 2);
378 
379 	/* Reset the bus.  Needed for Radeon video cards. */
380 	brctl = fsl_pcib_read_config(sc->sc_dev, 0, 0, 0,
381 	    PCIR_BRIDGECTL_1, 1);
382 	brctl |= PCIB_BCR_SECBUS_RESET;
383 	fsl_pcib_write_config(sc->sc_dev, 0, 0, 0,
384 	    PCIR_BRIDGECTL_1, brctl, 1);
385 	DELAY(100000);
386 	brctl &= ~PCIB_BCR_SECBUS_RESET;
387 	fsl_pcib_write_config(sc->sc_dev, 0, 0, 0,
388 	    PCIR_BRIDGECTL_1, brctl, 1);
389 	DELAY(100000);
390 
391 	if (sc->sc_pcie) {
392 		ltssm = fsl_pcib_cfgread(sc, 0, 0, 0, PCIR_LTSSM, 1);
393 		if (ltssm < LTSSM_STAT_L0) {
394 			if (bootverbose)
395 				printf("PCI %d: no PCIE link, skipping\n",
396 				    device_get_unit(dev));
397 			return (0);
398 		}
399 	}
400 
401 	/* Allocate irq */
402 	rid = 0;
403 	sc->sc_irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
404 	    RF_ACTIVE | RF_SHAREABLE);
405 	if (sc->sc_irq_res == NULL) {
406 		error = fsl_pcib_detach(dev);
407 		if (error != 0) {
408 			device_printf(dev,
409 			    "Detach of the driver failed with error %d\n",
410 			    error);
411 		}
412 		return (ENXIO);
413 	}
414 
415 	/* Setup interrupt handler */
416 	error = bus_setup_intr(dev, sc->sc_irq_res, INTR_TYPE_MISC | INTR_MPSAFE,
417 	    NULL, fsl_pcib_err_intr, dev, &sc->sc_ih);
418 	if (error != 0) {
419 		device_printf(dev, "Could not setup irq, %d\n", error);
420 		sc->sc_ih = NULL;
421 		error = fsl_pcib_detach(dev);
422 		if (error != 0) {
423 			device_printf(dev,
424 			    "Detach of the driver failed with error %d\n",
425 			    error);
426 		}
427 		return (ENXIO);
428 	}
429 
430 	fsl_pcib_err_init(dev);
431 
432 	return (ofw_pci_attach(dev));
433 
434 err:
435 	return (ENXIO);
436 }
437 
438 static uint32_t
439 fsl_pcib_cfgread(struct fsl_pcib_softc *sc, u_int bus, u_int slot, u_int func,
440     u_int reg, int bytes)
441 {
442 	uint32_t addr, data;
443 
444 	addr = CONFIG_ACCESS_ENABLE;
445 	addr |= (bus & 0xff) << 16;
446 	addr |= (slot & 0x1f) << 11;
447 	addr |= (func & 0x7) << 8;
448 	addr |= reg & 0xfc;
449 	if (sc->sc_pcie)
450 		addr |= (reg & 0xf00) << 16;
451 
452 	mtx_lock_spin(&sc->sc_cfg_mtx);
453 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_CFG_ADDR, addr);
454 
455 	switch (bytes) {
456 	case 1:
457 		data = bus_space_read_1(sc->sc_bst, sc->sc_bsh,
458 		    REG_CFG_DATA + (reg & 3));
459 		break;
460 	case 2:
461 		data = le16toh(bus_space_read_2(sc->sc_bst, sc->sc_bsh,
462 		    REG_CFG_DATA + (reg & 2)));
463 		break;
464 	case 4:
465 		data = le32toh(bus_space_read_4(sc->sc_bst, sc->sc_bsh,
466 		    REG_CFG_DATA));
467 		break;
468 	default:
469 		data = ~0;
470 		break;
471 	}
472 	mtx_unlock_spin(&sc->sc_cfg_mtx);
473 	return (data);
474 }
475 
476 static void
477 fsl_pcib_cfgwrite(struct fsl_pcib_softc *sc, u_int bus, u_int slot, u_int func,
478     u_int reg, uint32_t data, int bytes)
479 {
480 	uint32_t addr;
481 
482 	addr = CONFIG_ACCESS_ENABLE;
483 	addr |= (bus & 0xff) << 16;
484 	addr |= (slot & 0x1f) << 11;
485 	addr |= (func & 0x7) << 8;
486 	addr |= reg & 0xfc;
487 	if (sc->sc_pcie)
488 		addr |= (reg & 0xf00) << 16;
489 
490 	mtx_lock_spin(&sc->sc_cfg_mtx);
491 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_CFG_ADDR, addr);
492 
493 	switch (bytes) {
494 	case 1:
495 		bus_space_write_1(sc->sc_bst, sc->sc_bsh,
496 		    REG_CFG_DATA + (reg & 3), data);
497 		break;
498 	case 2:
499 		bus_space_write_2(sc->sc_bst, sc->sc_bsh,
500 		    REG_CFG_DATA + (reg & 2), htole16(data));
501 		break;
502 	case 4:
503 		bus_space_write_4(sc->sc_bst, sc->sc_bsh,
504 		    REG_CFG_DATA, htole32(data));
505 		break;
506 	}
507 	mtx_unlock_spin(&sc->sc_cfg_mtx);
508 }
509 
510 #if 0
511 static void
512 dump(struct fsl_pcib_softc *sc)
513 {
514 	unsigned int i;
515 
516 #define RD(o)	bus_space_read_4(sc->sc_bst, sc->sc_bsh, o)
517 	for (i = 0; i < 5; i++) {
518 		printf("POTAR%u  =0x%08x\n", i, RD(REG_POTAR(i)));
519 		printf("POTEAR%u =0x%08x\n", i, RD(REG_POTEAR(i)));
520 		printf("POWBAR%u =0x%08x\n", i, RD(REG_POWBAR(i)));
521 		printf("POWAR%u  =0x%08x\n", i, RD(REG_POWAR(i)));
522 	}
523 	printf("\n");
524 	for (i = 1; i < 4; i++) {
525 		printf("PITAR%u  =0x%08x\n", i, RD(REG_PITAR(i)));
526 		printf("PIWBAR%u =0x%08x\n", i, RD(REG_PIWBAR(i)));
527 		printf("PIWBEAR%u=0x%08x\n", i, RD(REG_PIWBEAR(i)));
528 		printf("PIWAR%u  =0x%08x\n", i, RD(REG_PIWAR(i)));
529 	}
530 	printf("\n");
531 #undef RD
532 
533 	for (i = 0; i < 0x48; i += 4) {
534 		printf("cfg%02x=0x%08x\n", i, fsl_pcib_cfgread(sc, 0, 0, 0,
535 		    i, 4));
536 	}
537 }
538 #endif
539 
540 static int
541 fsl_pcib_maxslots(device_t dev)
542 {
543 	struct fsl_pcib_softc *sc = device_get_softc(dev);
544 
545 	return ((sc->sc_pcie) ? 0 : PCI_SLOTMAX);
546 }
547 
548 static uint32_t
549 fsl_pcib_read_config(device_t dev, u_int bus, u_int slot, u_int func,
550     u_int reg, int bytes)
551 {
552 	struct fsl_pcib_softc *sc = device_get_softc(dev);
553 	u_int devfn;
554 
555 	if (bus == sc->sc_busnr && !sc->sc_pcie && slot < 10)
556 		return (~0);
557 	devfn = DEVFN(bus, slot, func);
558 
559 	return (fsl_pcib_cfgread(sc, bus, slot, func, reg, bytes));
560 }
561 
562 static void
563 fsl_pcib_write_config(device_t dev, u_int bus, u_int slot, u_int func,
564     u_int reg, uint32_t val, int bytes)
565 {
566 	struct fsl_pcib_softc *sc = device_get_softc(dev);
567 
568 	if (bus == sc->sc_busnr && !sc->sc_pcie && slot < 10)
569 		return;
570 	fsl_pcib_cfgwrite(sc, bus, slot, func, reg, val, bytes);
571 }
572 
573 static void
574 fsl_pcib_inbound(struct fsl_pcib_softc *sc, int wnd, int tgt, uint64_t start,
575     uint64_t size, uint64_t pci_start)
576 {
577 	uint32_t attr, bar, tar;
578 
579 	KASSERT(wnd > 0, ("%s: inbound window 0 is invalid", __func__));
580 
581 	attr = PIWAR_EN;
582 
583 	switch (tgt) {
584 	case -1:
585 		attr &= ~PIWAR_EN;
586 		break;
587 	case PIWAR_TRGT_LOCAL:
588 		attr |= (ffsl(size) - 2);
589 	default:
590 		attr |= (tgt << PIWAR_TRGT_S);
591 		break;
592 	}
593 	tar = start >> 12;
594 	bar = pci_start >> 12;
595 
596 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PITAR(wnd), tar);
597 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PIWBEAR(wnd), 0);
598 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PIWBAR(wnd), bar);
599 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PIWAR(wnd), attr);
600 }
601 
602 static void
603 fsl_pcib_outbound(struct fsl_pcib_softc *sc, int wnd, int res, uint64_t start,
604     uint64_t size, uint64_t pci_start)
605 {
606 	uint32_t attr, bar, tar;
607 
608 	switch (res) {
609 	case SYS_RES_MEMORY:
610 		attr = 0x80044000 | (ffsll(size) - 2);
611 		break;
612 	case SYS_RES_IOPORT:
613 		attr = 0x80088000 | (ffsll(size) - 2);
614 		break;
615 	default:
616 		attr = 0x0004401f;
617 		break;
618 	}
619 	bar = start >> 12;
620 	tar = pci_start >> 12;
621 
622 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_POTAR(wnd), tar);
623 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_POTEAR(wnd), 0);
624 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_POWBAR(wnd), bar);
625 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_POWAR(wnd), attr);
626 }
627 
628 static void
629 fsl_pcib_err_init(device_t dev)
630 {
631 	struct fsl_pcib_softc *sc;
632 	uint16_t sec_stat, dsr;
633 	uint32_t dcr, err_en;
634 
635 	sc = device_get_softc(dev);
636 
637 	sec_stat = fsl_pcib_cfgread(sc, 0, 0, 0, PCIR_SECSTAT_1, 2);
638 	if (sec_stat)
639 		fsl_pcib_cfgwrite(sc, 0, 0, 0, PCIR_SECSTAT_1, 0xffff, 2);
640 	if (sc->sc_pcie) {
641 		/* Clear error bits */
642 		bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PEX_MES_IER,
643 		    0xffffffff);
644 		bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PEX_MES_DR,
645 		    0xffffffff);
646 		bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PEX_ERR_DR,
647 		    0xffffffff);
648 
649 		dsr = fsl_pcib_cfgread(sc, 0, 0, 0,
650 		    sc->sc_pcie_capreg + PCIER_DEVICE_STA, 2);
651 		if (dsr)
652 			fsl_pcib_cfgwrite(sc, 0, 0, 0,
653 			    sc->sc_pcie_capreg + PCIER_DEVICE_STA,
654 			    0xffff, 2);
655 
656 		/* Enable all errors reporting */
657 		err_en = 0x00bfff00;
658 		bus_space_write_4(sc->sc_bst, sc->sc_bsh, REG_PEX_ERR_EN,
659 		    err_en);
660 
661 		/* Enable error reporting: URR, FER, NFER */
662 		dcr = fsl_pcib_cfgread(sc, 0, 0, 0,
663 		    sc->sc_pcie_capreg + PCIER_DEVICE_CTL, 4);
664 		dcr |= PCIEM_CTL_URR_ENABLE | PCIEM_CTL_FER_ENABLE |
665 		    PCIEM_CTL_NFER_ENABLE;
666 		fsl_pcib_cfgwrite(sc, 0, 0, 0,
667 		    sc->sc_pcie_capreg + PCIER_DEVICE_CTL, dcr, 4);
668 	}
669 }
670 
671 static int
672 fsl_pcib_detach(device_t dev)
673 {
674 	struct fsl_pcib_softc *sc;
675 
676 	sc = device_get_softc(dev);
677 
678 	mtx_destroy(&sc->sc_cfg_mtx);
679 
680 	return (bus_generic_detach(dev));
681 }
682 
683 static int
684 fsl_pcib_decode_win(phandle_t node, struct fsl_pcib_softc *sc)
685 {
686 	device_t dev;
687 	int error, i, trgt;
688 
689 	dev = sc->sc_dev;
690 
691 	fsl_pcib_outbound(sc, 0, -1, 0, 0, 0);
692 
693 	/*
694 	 * Configure LAW decode windows.
695 	 */
696 	error = law_pci_target(sc->sc_res, &sc->sc_iomem_target,
697 	    &sc->sc_ioport_target);
698 	if (error != 0) {
699 		device_printf(dev, "could not retrieve PCI LAW target info\n");
700 		return (error);
701 	}
702 
703 	for (i = 0; i < sc->pci_sc.sc_nrange; i++) {
704 		switch (sc->pci_sc.sc_range[i].pci_hi &
705 		    OFW_PCI_PHYS_HI_SPACEMASK) {
706 		case OFW_PCI_PHYS_HI_SPACE_CONFIG:
707 			continue;
708 		case OFW_PCI_PHYS_HI_SPACE_IO:
709 			trgt = sc->sc_ioport_target;
710 			fsl_pcib_outbound(sc, 2, SYS_RES_IOPORT,
711 			    sc->pci_sc.sc_range[i].host,
712 			    sc->pci_sc.sc_range[i].size,
713 			    sc->pci_sc.sc_range[i].pci);
714 			sc->sc_ioport_start = sc->pci_sc.sc_range[i].pci;
715 			sc->sc_ioport_end = sc->pci_sc.sc_range[i].pci +
716 			    sc->pci_sc.sc_range[i].size - 1;
717 			break;
718 		case OFW_PCI_PHYS_HI_SPACE_MEM32:
719 		case OFW_PCI_PHYS_HI_SPACE_MEM64:
720 			trgt = sc->sc_iomem_target;
721 			fsl_pcib_outbound(sc, 1, SYS_RES_MEMORY,
722 			    sc->pci_sc.sc_range[i].host,
723 			    sc->pci_sc.sc_range[i].size,
724 			    sc->pci_sc.sc_range[i].pci);
725 			sc->sc_iomem_start = sc->pci_sc.sc_range[i].pci;
726 			sc->sc_iomem_end = sc->pci_sc.sc_range[i].pci +
727 			    sc->pci_sc.sc_range[i].size - 1;
728 			break;
729 		default:
730 			panic("Unknown range type %#x\n",
731 			    sc->pci_sc.sc_range[i].pci_hi &
732 			    OFW_PCI_PHYS_HI_SPACEMASK);
733 		}
734 		error = law_enable(trgt, sc->pci_sc.sc_range[i].host,
735 		    sc->pci_sc.sc_range[i].size);
736 		if (error != 0) {
737 			device_printf(dev, "could not program LAW for range "
738 			    "%d\n", i);
739 			return (error);
740 		}
741 	}
742 
743 	/*
744 	 * Set outbout and inbound windows.
745 	 */
746 	fsl_pcib_outbound(sc, 3, -1, 0, 0, 0);
747 	fsl_pcib_outbound(sc, 4, -1, 0, 0, 0);
748 
749 	fsl_pcib_inbound(sc, 1, -1, 0, 0, 0);
750 	fsl_pcib_inbound(sc, 2, -1, 0, 0, 0);
751 	fsl_pcib_inbound(sc, 3, PIWAR_TRGT_LOCAL, 0,
752 	    ptoa(Maxmem), 0);
753 
754 	/* Direct-map the CCSR for MSIs. */
755 	/* Freescale PCIe 2.x has a dedicated MSI window. */
756 	/* inbound window 8 makes it hit 0xD00 offset, the MSI window. */
757 	if (sc->sc_ip_maj >= 2)
758 		fsl_pcib_inbound(sc, 8, PIWAR_TRGT_CCSR, ccsrbar_pa,
759 		    ccsrbar_size, ccsrbar_pa);
760 	else
761 		fsl_pcib_inbound(sc, 1, PIWAR_TRGT_CCSR, ccsrbar_pa,
762 		    ccsrbar_size, ccsrbar_pa);
763 
764 	return (0);
765 }
766 
767 static int fsl_pcib_alloc_msi(device_t dev, device_t child,
768     int count, int maxcount, int *irqs)
769 {
770 	struct fsl_pcib_softc *sc;
771 	vmem_addr_t start;
772 	int err, i;
773 
774 	sc = device_get_softc(dev);
775 	if (msi_vmem == NULL)
776 		return (ENODEV);
777 
778 	err = vmem_xalloc(msi_vmem, count, powerof2(count), 0, 0,
779 	    VMEM_ADDR_MIN, VMEM_ADDR_MAX, M_BESTFIT | M_WAITOK, &start);
780 
781 	if (err)
782 		return (err);
783 
784 	for (i = 0; i < count; i++)
785 		irqs[i] = start + i;
786 
787 	return (0);
788 }
789 
790 static int fsl_pcib_release_msi(device_t dev, device_t child,
791     int count, int *irqs)
792 {
793 	if (msi_vmem == NULL)
794 		return (ENODEV);
795 
796 	vmem_xfree(msi_vmem, irqs[0], count);
797 	return (0);
798 }
799 
800 static int fsl_pcib_alloc_msix(device_t dev, device_t child, int *irq)
801 {
802 	return (fsl_pcib_alloc_msi(dev, child, 1, 1, irq));
803 }
804 
805 static int fsl_pcib_release_msix(device_t dev, device_t child, int irq)
806 {
807 	return (fsl_pcib_release_msi(dev, child, 1, &irq));
808 }
809 
810 static int fsl_pcib_map_msi(device_t dev, device_t child,
811     int irq, uint64_t *addr, uint32_t *data)
812 {
813 	struct fsl_msi_map *mp;
814 
815 	SLIST_FOREACH(mp, &fsl_msis, slist) {
816 		if (irq >= mp->irq_base && irq < mp->irq_base + FSL_NUM_MSIS)
817 			break;
818 	}
819 
820 	if (mp == NULL)
821 		return (ENODEV);
822 
823 	*data = (irq & 255);
824 	*addr = ccsrbar_pa + mp->target;
825 
826 	return (0);
827 }
828 
829 /*
830  * Linux device trees put the msi@<x> as children of the SoC, with ranges based
831  * on the CCSR.  Since rman doesn't permit overlapping or sub-ranges between
832  * devices (bus_space_subregion(9) could do it, but let's not touch the PIC
833  * driver just to allocate a subregion for a sibling driver).  This driver will
834  * use ccsr_write() and ccsr_read() instead.
835  */
836 
837 #define	FSL_NUM_IRQS		8
838 #define	FSL_NUM_MSI_PER_IRQ	32
839 #define	FSL_MSI_TARGET	0x140
840 
841 struct fsl_msi_softc {
842 	vm_offset_t	sc_base;
843 	vm_offset_t	sc_target;
844 	int		sc_msi_base_irq;
845 	struct fsl_msi_map sc_map;
846 	struct fsl_msi_irq {
847 		/* This struct gets passed as the filter private data. */
848 		struct fsl_msi_softc *sc_ptr;	/* Pointer back to softc. */
849 		struct resource *res;
850 		int irq;
851 		void *cookie;
852 		int vectors[FSL_NUM_MSI_PER_IRQ];
853 		vm_offset_t reg;
854 	} sc_msi_irq[FSL_NUM_IRQS];
855 };
856 
857 static int
858 fsl_msi_intr_filter(void *priv)
859 {
860 	struct fsl_msi_irq *data = priv;
861 	uint32_t reg;
862 	int i;
863 
864 	reg = ccsr_read4(ccsrbar_va + data->reg);
865 	i = 0;
866 	while (reg != 0) {
867 		if (reg & 1)
868 			powerpc_dispatch_intr(data->vectors[i], NULL);
869 		reg >>= 1;
870 		i++;
871 	}
872 
873 	return (FILTER_HANDLED);
874 }
875 
876 static int
877 fsl_msi_probe(device_t dev)
878 {
879 	if (!ofw_bus_is_compatible(dev, "fsl,mpic-msi"))
880 		return (ENXIO);
881 
882 	device_set_desc(dev, "Freescale MSI");
883 
884 	return (BUS_PROBE_DEFAULT);
885 }
886 
887 static int
888 fsl_msi_attach(device_t dev)
889 {
890 	struct fsl_msi_softc *sc;
891 	struct fsl_msi_irq *irq;
892 	int i;
893 
894 	sc = device_get_softc(dev);
895 
896 	if (msi_vmem == NULL)
897 		msi_vmem = vmem_create("MPIC MSI", 0, 0, 1, 0, M_BESTFIT | M_WAITOK);
898 
899 	/* Manually play with resource entries. */
900 	sc->sc_base = bus_get_resource_start(dev, SYS_RES_MEMORY, 0);
901 	sc->sc_map.target = bus_get_resource_start(dev, SYS_RES_MEMORY, 1);
902 
903 	if (sc->sc_map.target == 0)
904 		sc->sc_map.target = sc->sc_base + FSL_MSI_TARGET;
905 
906 	for (i = 0; i < FSL_NUM_IRQS; i++) {
907 		irq = &sc->sc_msi_irq[i];
908 		irq->irq = i;
909 		irq->reg = sc->sc_base + 16 * i;
910 		irq->res = bus_alloc_resource_any(dev, SYS_RES_IRQ,
911 		    &irq->irq, RF_ACTIVE);
912 		bus_setup_intr(dev, irq->res, INTR_TYPE_MISC | INTR_MPSAFE,
913 		    fsl_msi_intr_filter, NULL, irq, &irq->cookie);
914 	}
915 	sc->sc_map.irq_base = powerpc_register_pic(dev, ofw_bus_get_node(dev),
916 	    FSL_NUM_MSIS, 0, 0);
917 
918 	/* Let vmem and the IRQ subsystem work their magic for allocations. */
919 	vmem_add(msi_vmem, sc->sc_map.irq_base, FSL_NUM_MSIS, M_WAITOK);
920 
921 	SLIST_INSERT_HEAD(&fsl_msis, &sc->sc_map, slist);
922 
923 	return (0);
924 }
925 
926 static void
927 fsl_msi_enable(device_t dev, u_int irq, u_int vector, void **priv)
928 {
929 	struct fsl_msi_softc *sc;
930 	struct fsl_msi_irq *irqd;
931 
932 	sc = device_get_softc(dev);
933 
934 	irqd = &sc->sc_msi_irq[irq / FSL_NUM_MSI_PER_IRQ];
935 	irqd->vectors[irq % FSL_NUM_MSI_PER_IRQ] = vector;
936 }
937 
938 static device_method_t fsl_msi_methods[] = {
939 	DEVMETHOD(device_probe,		fsl_msi_probe),
940 	DEVMETHOD(device_attach,	fsl_msi_attach),
941 
942 	DEVMETHOD(pic_enable,		fsl_msi_enable),
943 	DEVMETHOD_END
944 };
945 
946 static devclass_t fsl_msi_devclass;
947 
948 static driver_t fsl_msi_driver = {
949 	"fsl_msi",
950 	fsl_msi_methods,
951 	sizeof(struct fsl_msi_softc)
952 };
953 
954 EARLY_DRIVER_MODULE(fsl_msi, simplebus, fsl_msi_driver, fsl_msi_devclass, 0, 0,
955     BUS_PASS_INTERRUPT + 1);
956