Home | History | Annotate | Line # | Download | only in pci
pci_machdep.c revision 1.20.6.2
      1  1.20.6.1     skrll /*	$NetBSD: pci_machdep.c,v 1.20.6.2 2004/09/18 14:37:09 skrll Exp $	*/
      2       1.1    tsubai 
      3       1.1    tsubai /*
      4       1.1    tsubai  * Copyright (c) 1996 Christopher G. Demetriou.  All rights reserved.
      5       1.5   mycroft  * Copyright (c) 1994 Charles M. Hannum.  All rights reserved.
      6       1.1    tsubai  *
      7       1.1    tsubai  * Redistribution and use in source and binary forms, with or without
      8       1.1    tsubai  * modification, are permitted provided that the following conditions
      9       1.1    tsubai  * are met:
     10       1.1    tsubai  * 1. Redistributions of source code must retain the above copyright
     11       1.1    tsubai  *    notice, this list of conditions and the following disclaimer.
     12       1.1    tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1    tsubai  *    notice, this list of conditions and the following disclaimer in the
     14       1.1    tsubai  *    documentation and/or other materials provided with the distribution.
     15       1.1    tsubai  * 3. All advertising materials mentioning features or use of this software
     16       1.1    tsubai  *    must display the following acknowledgement:
     17       1.5   mycroft  *	This product includes software developed by Charles M. Hannum.
     18       1.1    tsubai  * 4. The name of the author may not be used to endorse or promote products
     19       1.1    tsubai  *    derived from this software without specific prior written permission.
     20       1.1    tsubai  *
     21       1.1    tsubai  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22       1.1    tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23       1.1    tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24       1.1    tsubai  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25       1.1    tsubai  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26       1.1    tsubai  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27       1.1    tsubai  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28       1.1    tsubai  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29       1.1    tsubai  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30       1.1    tsubai  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31       1.1    tsubai  */
     32       1.1    tsubai 
     33       1.1    tsubai /*
     34       1.1    tsubai  * Machine-specific functions for PCI autoconfiguration.
     35       1.1    tsubai  *
     36       1.1    tsubai  * On PCs, there are two methods of generating PCI configuration cycles.
     37       1.1    tsubai  * We try to detect the appropriate mechanism for this machine and set
     38       1.1    tsubai  * up a few function pointers to access the correct method directly.
     39       1.1    tsubai  *
     40       1.1    tsubai  * The configuration method can be hard-coded in the config file by
     41       1.1    tsubai  * using `options PCI_CONF_MODE=N', where `N' is the configuration mode
     42       1.1    tsubai  * as defined section 3.6.4.1, `Generating Configuration Cycles'.
     43       1.1    tsubai  */
     44       1.1    tsubai 
     45  1.20.6.1     skrll #include <sys/cdefs.h>
     46  1.20.6.1     skrll __KERNEL_RCSID(0, "$NetBSD: pci_machdep.c,v 1.20.6.2 2004/09/18 14:37:09 skrll Exp $");
     47  1.20.6.1     skrll 
     48       1.1    tsubai #include <sys/types.h>
     49       1.1    tsubai #include <sys/param.h>
     50       1.1    tsubai #include <sys/time.h>
     51       1.1    tsubai #include <sys/systm.h>
     52       1.1    tsubai #include <sys/errno.h>
     53       1.1    tsubai #include <sys/device.h>
     54       1.1    tsubai 
     55      1.13       mrg #include <uvm/uvm_extern.h>
     56       1.1    tsubai 
     57       1.3    tsubai #define _MACPPC_BUS_DMA_PRIVATE
     58       1.3    tsubai #include <machine/bus.h>
     59       1.3    tsubai 
     60       1.1    tsubai #include <machine/bus.h>
     61       1.1    tsubai #include <machine/pio.h>
     62       1.1    tsubai #include <machine/intr.h>
     63       1.1    tsubai 
     64       1.1    tsubai #include <dev/pci/pcivar.h>
     65       1.1    tsubai #include <dev/pci/pcireg.h>
     66       1.1    tsubai 
     67      1.10    tsubai #include <dev/ofw/openfirm.h>
     68      1.10    tsubai #include <dev/ofw/ofw_pci.h>
     69      1.10    tsubai 
     70      1.10    tsubai static void fixpci __P((int, pci_chipset_tag_t));
     71      1.10    tsubai static int find_node_intr __P((int, u_int32_t *, u_int32_t *));
     72      1.10    tsubai 
     73       1.3    tsubai /*
     74       1.3    tsubai  * PCI doesn't have any special needs; just use the generic versions
     75       1.3    tsubai  * of these functions.
     76       1.3    tsubai  */
     77       1.3    tsubai struct macppc_bus_dma_tag pci_bus_dma_tag = {
     78       1.3    tsubai 	0,			/* _bounce_thresh */
     79       1.3    tsubai 	_bus_dmamap_create,
     80       1.3    tsubai 	_bus_dmamap_destroy,
     81       1.3    tsubai 	_bus_dmamap_load,
     82       1.3    tsubai 	_bus_dmamap_load_mbuf,
     83       1.3    tsubai 	_bus_dmamap_load_uio,
     84       1.3    tsubai 	_bus_dmamap_load_raw,
     85       1.3    tsubai 	_bus_dmamap_unload,
     86       1.3    tsubai 	NULL,			/* _dmamap_sync */
     87       1.3    tsubai 	_bus_dmamem_alloc,
     88       1.3    tsubai 	_bus_dmamem_free,
     89       1.3    tsubai 	_bus_dmamem_map,
     90       1.3    tsubai 	_bus_dmamem_unmap,
     91       1.3    tsubai 	_bus_dmamem_mmap,
     92       1.3    tsubai };
     93       1.1    tsubai 
     94       1.1    tsubai void
     95       1.1    tsubai pci_attach_hook(parent, self, pba)
     96       1.1    tsubai 	struct device *parent, *self;
     97       1.1    tsubai 	struct pcibus_attach_args *pba;
     98       1.1    tsubai {
     99      1.10    tsubai 	pci_chipset_tag_t pc = pba->pba_pc;
    100      1.10    tsubai 	int bus = pba->pba_bus;
    101      1.10    tsubai 	int node, nn, sz;
    102      1.10    tsubai 	int32_t busrange[2];
    103      1.10    tsubai 
    104      1.10    tsubai 	for (node = pc->node; node; node = nn) {
    105      1.10    tsubai 		sz = OF_getprop(node, "bus-range", busrange, 8);
    106      1.10    tsubai 		if (sz == 8 && busrange[0] == bus) {
    107      1.10    tsubai 			fixpci(node, pc);
    108      1.10    tsubai 			return;
    109      1.10    tsubai 		}
    110      1.10    tsubai 		if ((nn = OF_child(node)) != 0)
    111      1.10    tsubai 			continue;
    112      1.10    tsubai 		while ((nn = OF_peer(node)) == 0) {
    113      1.10    tsubai 			node = OF_parent(node);
    114      1.10    tsubai 			if (node == pc->node)
    115      1.10    tsubai 				return;		/* not found */
    116      1.10    tsubai 		}
    117      1.10    tsubai 	}
    118       1.1    tsubai }
    119       1.1    tsubai 
    120       1.1    tsubai int
    121       1.1    tsubai pci_bus_maxdevs(pc, busno)
    122       1.1    tsubai 	pci_chipset_tag_t pc;
    123       1.1    tsubai 	int busno;
    124       1.1    tsubai {
    125       1.1    tsubai 
    126       1.1    tsubai 	/*
    127       1.1    tsubai 	 * Bus number is irrelevant.  Configuration Mechanism 1 is in
    128       1.1    tsubai 	 * use, can have devices 0-32 (i.e. the `normal' range).
    129       1.1    tsubai 	 */
    130       1.3    tsubai 	return 32;
    131       1.1    tsubai }
    132       1.1    tsubai 
    133       1.1    tsubai pcitag_t
    134       1.1    tsubai pci_make_tag(pc, bus, device, function)
    135       1.1    tsubai 	pci_chipset_tag_t pc;
    136       1.1    tsubai 	int bus, device, function;
    137       1.1    tsubai {
    138       1.1    tsubai 	pcitag_t tag;
    139       1.1    tsubai 
    140       1.1    tsubai 	if (bus >= 256 || device >= 32 || function >= 8)
    141       1.1    tsubai 		panic("pci_make_tag: bad request");
    142       1.1    tsubai 
    143       1.9   thorpej 	/* XXX magic number */
    144       1.3    tsubai 	tag = 0x80000000 | (bus << 16) | (device << 11) | (function << 8);
    145       1.1    tsubai 
    146       1.1    tsubai 	return tag;
    147       1.1    tsubai }
    148       1.1    tsubai 
    149       1.1    tsubai void
    150       1.1    tsubai pci_decompose_tag(pc, tag, bp, dp, fp)
    151       1.1    tsubai 	pci_chipset_tag_t pc;
    152       1.1    tsubai 	pcitag_t tag;
    153       1.1    tsubai 	int *bp, *dp, *fp;
    154       1.1    tsubai {
    155       1.9   thorpej 
    156       1.3    tsubai 	if (bp != NULL)
    157       1.3    tsubai 		*bp = (tag >> 16) & 0xff;
    158       1.3    tsubai 	if (dp != NULL)
    159       1.3    tsubai 		*dp = (tag >> 11) & 0x1f;
    160       1.3    tsubai 	if (fp != NULL)
    161       1.9   thorpej 		*fp = (tag >> 8) & 0x07;
    162       1.1    tsubai }
    163       1.1    tsubai 
    164       1.1    tsubai pcireg_t
    165       1.1    tsubai pci_conf_read(pc, tag, reg)
    166       1.1    tsubai 	pci_chipset_tag_t pc;
    167       1.1    tsubai 	pcitag_t tag;
    168       1.1    tsubai 	int reg;
    169       1.1    tsubai {
    170       1.2    tsubai 
    171      1.10    tsubai 	return (*pc->conf_read)(pc, tag, reg);
    172       1.1    tsubai }
    173       1.1    tsubai 
    174       1.1    tsubai void
    175       1.1    tsubai pci_conf_write(pc, tag, reg, data)
    176       1.1    tsubai 	pci_chipset_tag_t pc;
    177       1.1    tsubai 	pcitag_t tag;
    178       1.1    tsubai 	int reg;
    179       1.1    tsubai 	pcireg_t data;
    180       1.1    tsubai {
    181       1.2    tsubai 
    182      1.10    tsubai 	(*pc->conf_write)(pc, tag, reg, data);
    183       1.1    tsubai }
    184       1.1    tsubai 
    185       1.1    tsubai int
    186      1.14  sommerfe pci_intr_map(pa, ihp)
    187      1.14  sommerfe 	struct pci_attach_args *pa;
    188       1.1    tsubai 	pci_intr_handle_t *ihp;
    189       1.1    tsubai {
    190      1.14  sommerfe 	int pin = pa->pa_intrpin;
    191      1.14  sommerfe 	int line = pa->pa_intrline;
    192       1.1    tsubai 
    193       1.1    tsubai 	if (pin == 0) {
    194       1.1    tsubai 		/* No IRQ used. */
    195       1.1    tsubai 		goto bad;
    196       1.1    tsubai 	}
    197       1.1    tsubai 
    198       1.1    tsubai 	if (pin > 4) {
    199       1.1    tsubai 		printf("pci_intr_map: bad interrupt pin %d\n", pin);
    200       1.1    tsubai 		goto bad;
    201       1.1    tsubai 	}
    202       1.1    tsubai 
    203       1.1    tsubai 	/*
    204       1.1    tsubai 	 * Section 6.2.4, `Miscellaneous Functions', says that 255 means
    205       1.1    tsubai 	 * `unknown' or `no connection' on a PC.  We assume that a device with
    206       1.1    tsubai 	 * `no connection' either doesn't have an interrupt (in which case the
    207       1.1    tsubai 	 * pin number should be 0, and would have been noticed above), or
    208       1.1    tsubai 	 * wasn't configured by the BIOS (in which case we punt, since there's
    209       1.1    tsubai 	 * no real way we can know how the interrupt lines are mapped in the
    210       1.1    tsubai 	 * hardware).
    211       1.1    tsubai 	 *
    212       1.1    tsubai 	 * XXX
    213       1.1    tsubai 	 * Since IRQ 0 is only used by the clock, and we can't actually be sure
    214       1.1    tsubai 	 * that the BIOS did its job, we also recognize that as meaning that
    215       1.1    tsubai 	 * the BIOS has not configured the device.
    216       1.1    tsubai 	 */
    217       1.1    tsubai 	if (line == 0 || line == 255) {
    218       1.1    tsubai 		printf("pci_intr_map: no mapping for pin %c\n", '@' + pin);
    219       1.1    tsubai 		goto bad;
    220       1.1    tsubai 	} else {
    221       1.1    tsubai 		if (line >= ICU_LEN) {
    222       1.1    tsubai 			printf("pci_intr_map: bad interrupt line %d\n", line);
    223       1.1    tsubai 			goto bad;
    224       1.1    tsubai 		}
    225       1.1    tsubai 	}
    226       1.1    tsubai 
    227       1.1    tsubai 	*ihp = line;
    228       1.1    tsubai 	return 0;
    229       1.1    tsubai 
    230       1.1    tsubai bad:
    231       1.1    tsubai 	*ihp = -1;
    232       1.1    tsubai 	return 1;
    233       1.1    tsubai }
    234       1.1    tsubai 
    235       1.1    tsubai const char *
    236       1.1    tsubai pci_intr_string(pc, ih)
    237       1.1    tsubai 	pci_chipset_tag_t pc;
    238       1.1    tsubai 	pci_intr_handle_t ih;
    239       1.1    tsubai {
    240       1.1    tsubai 	static char irqstr[8];		/* 4 + 2 + NULL + sanity */
    241       1.1    tsubai 
    242       1.1    tsubai 	if (ih == 0 || ih >= ICU_LEN)
    243      1.20    provos 		panic("pci_intr_string: bogus handle 0x%x", ih);
    244       1.1    tsubai 
    245       1.1    tsubai 	sprintf(irqstr, "irq %d", ih);
    246       1.1    tsubai 	return (irqstr);
    247       1.1    tsubai 
    248      1.11       cgd }
    249      1.11       cgd 
    250      1.11       cgd const struct evcnt *
    251      1.11       cgd pci_intr_evcnt(pc, ih)
    252      1.11       cgd 	pci_chipset_tag_t pc;
    253      1.11       cgd 	pci_intr_handle_t ih;
    254      1.11       cgd {
    255      1.11       cgd 
    256      1.11       cgd 	/* XXX for now, no evcnt parent reported */
    257      1.11       cgd 	return NULL;
    258       1.1    tsubai }
    259       1.1    tsubai 
    260       1.1    tsubai void *
    261       1.1    tsubai pci_intr_establish(pc, ih, level, func, arg)
    262       1.1    tsubai 	pci_chipset_tag_t pc;
    263       1.1    tsubai 	pci_intr_handle_t ih;
    264       1.1    tsubai 	int level, (*func) __P((void *));
    265       1.1    tsubai 	void *arg;
    266       1.1    tsubai {
    267       1.1    tsubai 
    268       1.1    tsubai 	if (ih == 0 || ih >= ICU_LEN)
    269      1.20    provos 		panic("pci_intr_establish: bogus handle 0x%x", ih);
    270       1.1    tsubai 
    271       1.1    tsubai 	return intr_establish(ih, IST_LEVEL, level, func, arg);
    272       1.1    tsubai }
    273       1.1    tsubai 
    274       1.1    tsubai void
    275       1.1    tsubai pci_intr_disestablish(pc, cookie)
    276       1.1    tsubai 	pci_chipset_tag_t pc;
    277       1.1    tsubai 	void *cookie;
    278       1.1    tsubai {
    279       1.1    tsubai 
    280       1.1    tsubai 	intr_disestablish(cookie);
    281      1.10    tsubai }
    282      1.10    tsubai 
    283      1.10    tsubai #define pcibus(x) \
    284      1.10    tsubai 	(((x) & OFW_PCI_PHYS_HI_BUSMASK) >> OFW_PCI_PHYS_HI_BUSSHIFT)
    285      1.10    tsubai #define pcidev(x) \
    286      1.10    tsubai 	(((x) & OFW_PCI_PHYS_HI_DEVICEMASK) >> OFW_PCI_PHYS_HI_DEVICESHIFT)
    287      1.10    tsubai #define pcifunc(x) \
    288      1.10    tsubai 	(((x) & OFW_PCI_PHYS_HI_FUNCTIONMASK) >> OFW_PCI_PHYS_HI_FUNCTIONSHIFT)
    289      1.10    tsubai 
    290      1.10    tsubai void
    291      1.10    tsubai fixpci(parent, pc)
    292      1.10    tsubai 	int parent;
    293      1.10    tsubai 	pci_chipset_tag_t pc;
    294      1.10    tsubai {
    295      1.10    tsubai 	int node;
    296      1.10    tsubai 	pcitag_t tag;
    297      1.10    tsubai 	pcireg_t csr, intr;
    298  1.20.6.1     skrll 	int len, i, ilen;
    299      1.10    tsubai 	int32_t irqs[4];
    300      1.10    tsubai 	struct {
    301      1.10    tsubai 		u_int32_t phys_hi, phys_mid, phys_lo;
    302      1.10    tsubai 		u_int32_t size_hi, size_lo;
    303      1.10    tsubai 	} addr[8];
    304  1.20.6.1     skrll 	struct {
    305  1.20.6.1     skrll 		u_int32_t phys_hi, phys_mid, phys_lo;
    306  1.20.6.1     skrll 		u_int32_t icells[5];
    307  1.20.6.1     skrll 	} iaddr;
    308      1.10    tsubai 
    309  1.20.6.1     skrll 	len = OF_getprop(parent, "#interrupt-cells", &ilen, sizeof(ilen));
    310  1.20.6.1     skrll 	if (len < 0)
    311  1.20.6.1     skrll 		ilen = 0;
    312      1.10    tsubai 	for (node = OF_child(parent); node; node = OF_peer(node)) {
    313      1.10    tsubai 		len = OF_getprop(node, "assigned-addresses", addr,
    314      1.10    tsubai 				 sizeof(addr));
    315      1.10    tsubai 		if (len < (int)sizeof(addr[0]))
    316      1.10    tsubai 			continue;
    317      1.10    tsubai 
    318      1.10    tsubai 		tag = pci_make_tag(pc, pcibus(addr[0].phys_hi),
    319      1.10    tsubai 				   pcidev(addr[0].phys_hi),
    320      1.10    tsubai 				   pcifunc(addr[0].phys_hi));
    321      1.10    tsubai 
    322      1.10    tsubai 		/*
    323      1.10    tsubai 		 * Make sure the IO and MEM enable bits are set in the CSR.
    324      1.10    tsubai 		 */
    325      1.10    tsubai 		csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    326      1.10    tsubai 		csr &= ~(PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE);
    327      1.10    tsubai 
    328      1.10    tsubai 		for (i = 0; i < len / sizeof(addr[0]); i++) {
    329      1.10    tsubai 			switch (addr[i].phys_hi & OFW_PCI_PHYS_HI_SPACEMASK) {
    330      1.10    tsubai 			case OFW_PCI_PHYS_HI_SPACE_IO:
    331      1.10    tsubai 				csr |= PCI_COMMAND_IO_ENABLE;
    332      1.10    tsubai 				break;
    333      1.10    tsubai 
    334      1.10    tsubai 			case OFW_PCI_PHYS_HI_SPACE_MEM32:
    335      1.19  wrstuden 			case OFW_PCI_PHYS_HI_SPACE_MEM64:
    336      1.10    tsubai 				csr |= PCI_COMMAND_MEM_ENABLE;
    337      1.10    tsubai 				break;
    338      1.10    tsubai 			}
    339      1.10    tsubai 		}
    340      1.10    tsubai 
    341      1.10    tsubai 		pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, csr);
    342      1.10    tsubai 
    343      1.10    tsubai 		/*
    344      1.10    tsubai 		 * Make sure the line register is programmed with the
    345      1.10    tsubai 		 * interrupt mapping.
    346      1.10    tsubai 		 */
    347  1.20.6.1     skrll 		if (ilen == 0) {
    348  1.20.6.1     skrll 			/*
    349  1.20.6.1     skrll 			 * Early Apple OFW implementation don't handle
    350  1.20.6.1     skrll 			 * interrupts as defined by the OFW PCI bindings.
    351  1.20.6.1     skrll 			 */
    352  1.20.6.1     skrll 			len = OF_getprop(node, "AAPL,interrupts", irqs, 4);
    353  1.20.6.1     skrll 		} else {
    354  1.20.6.1     skrll 			iaddr.phys_hi = addr[0].phys_hi;
    355  1.20.6.1     skrll 			iaddr.phys_mid = addr[0].phys_mid;
    356  1.20.6.1     skrll 			iaddr.phys_lo = addr[0].phys_lo;
    357  1.20.6.1     skrll 			/*
    358  1.20.6.1     skrll 			 * Thankfully, PCI can only have one entry in its
    359  1.20.6.1     skrll 			 * "interrupts" property.
    360  1.20.6.1     skrll 			 */
    361  1.20.6.1     skrll 			len = OF_getprop(node, "interrupts", &iaddr.icells[0],
    362  1.20.6.1     skrll 			    4*ilen);
    363  1.20.6.1     skrll 			if (len != 4*ilen)
    364  1.20.6.1     skrll 				continue;
    365  1.20.6.1     skrll 			len = find_node_intr(node, &iaddr.phys_hi, irqs);
    366  1.20.6.1     skrll 		}
    367  1.20.6.1     skrll 		if (len > 0) {
    368  1.20.6.1     skrll 			intr = pci_conf_read(pc, tag, PCI_INTERRUPT_REG);
    369  1.20.6.1     skrll 			intr &= ~PCI_INTERRUPT_LINE_MASK;
    370  1.20.6.1     skrll 			intr |= irqs[0] & PCI_INTERRUPT_LINE_MASK;
    371  1.20.6.1     skrll 			pci_conf_write(pc, tag, PCI_INTERRUPT_REG, intr);
    372  1.20.6.1     skrll 		}
    373      1.10    tsubai 	}
    374      1.10    tsubai }
    375      1.10    tsubai 
    376      1.10    tsubai /*
    377      1.10    tsubai  * Find PCI IRQ of the node from OF tree.
    378      1.10    tsubai  */
    379      1.10    tsubai int
    380      1.10    tsubai find_node_intr(node, addr, intr)
    381      1.10    tsubai 	int node;
    382      1.10    tsubai 	u_int32_t *addr, *intr;
    383      1.10    tsubai {
    384      1.10    tsubai 	int parent, len, mlen, iparent;
    385      1.10    tsubai 	int match, i;
    386  1.20.6.1     skrll 	u_int32_t map[160];
    387  1.20.6.1     skrll 	const u_int32_t *mp;
    388      1.10    tsubai 	u_int32_t imask[8], maskedaddr[8];
    389  1.20.6.1     skrll 	u_int32_t acells, icells;
    390      1.10    tsubai 	char name[32];
    391      1.10    tsubai 
    392      1.10    tsubai 	parent = OF_parent(node);
    393      1.10    tsubai 	len = OF_getprop(parent, "interrupt-map", map, sizeof(map));
    394      1.10    tsubai 	mlen = OF_getprop(parent, "interrupt-map-mask", imask, sizeof(imask));
    395      1.10    tsubai 
    396  1.20.6.1     skrll 	if (mlen != -1)
    397  1.20.6.1     skrll 		memcpy(maskedaddr, addr, mlen);
    398  1.20.6.1     skrll again:
    399      1.10    tsubai 	if (len == -1 || mlen == -1)
    400      1.10    tsubai 		goto nomap;
    401      1.10    tsubai 
    402      1.10    tsubai #ifdef DIAGNOSTIC
    403      1.10    tsubai 	if (mlen == sizeof(imask)) {
    404      1.10    tsubai 		printf("interrupt-map too long\n");
    405      1.10    tsubai 		return -1;
    406      1.10    tsubai 	}
    407      1.10    tsubai #endif
    408      1.10    tsubai 
    409      1.10    tsubai 	/* mask addr by "interrupt-map-mask" */
    410      1.10    tsubai 	for (i = 0; i < mlen / 4; i++)
    411      1.10    tsubai 		maskedaddr[i] &= imask[i];
    412      1.10    tsubai 
    413      1.10    tsubai 	mp = map;
    414  1.20.6.1     skrll 	i = 0;
    415      1.10    tsubai 	while (len > mlen) {
    416      1.18       wiz 		match = memcmp(maskedaddr, mp, mlen);
    417      1.10    tsubai 		mp += mlen / 4;
    418      1.10    tsubai 		len -= mlen;
    419      1.10    tsubai 
    420      1.10    tsubai 		/*
    421  1.20.6.1     skrll 		 * We must read "#address-cells" and "#interrupt-cells" each
    422  1.20.6.1     skrll 		 * time because each interrupt-parent may be different.
    423      1.10    tsubai 		 */
    424      1.10    tsubai 		iparent = *mp++;
    425      1.10    tsubai 		len -= 4;
    426  1.20.6.1     skrll 		i = OF_getprop(iparent, "#address-cells", &acells, 4);
    427  1.20.6.1     skrll 		if (i <= 0)
    428  1.20.6.1     skrll 			acells = 0;
    429  1.20.6.1     skrll 		else if (i != 4)
    430  1.20.6.1     skrll 			return -1;
    431      1.10    tsubai 		if (OF_getprop(iparent, "#interrupt-cells", &icells, 4) != 4)
    432  1.20.6.1     skrll 			return -1;
    433      1.10    tsubai 
    434      1.10    tsubai 		/* Found. */
    435      1.10    tsubai 		if (match == 0) {
    436  1.20.6.1     skrll 			/*
    437  1.20.6.1     skrll 			 * We matched on address/interrupt, but are we done?
    438  1.20.6.1     skrll 			 */
    439  1.20.6.1     skrll 			if (acells == 0) { /* XXX */
    440  1.20.6.1     skrll 				/*
    441  1.20.6.1     skrll 				 * If we are at the interrupt controller,
    442  1.20.6.1     skrll 				 * we are finally done.  Save the result and
    443  1.20.6.1     skrll 				 * return.
    444  1.20.6.1     skrll 				 */
    445  1.20.6.1     skrll 				memcpy(intr, mp, icells * 4);
    446  1.20.6.1     skrll 				return icells * 4;
    447  1.20.6.1     skrll 			}
    448  1.20.6.1     skrll 			/*
    449  1.20.6.1     skrll 			 * We are now at an intermedia interrupt node.  We
    450  1.20.6.1     skrll 			 * need to use its interrupt mask and map the
    451  1.20.6.1     skrll 			 * supplied address/interrupt via its map.
    452  1.20.6.1     skrll 			 */
    453  1.20.6.1     skrll 			mlen = OF_getprop(iparent, "interrupt-map-mask",
    454  1.20.6.1     skrll 			    imask, sizeof(imask));
    455  1.20.6.1     skrll #ifdef DIAGNOSTIC
    456  1.20.6.1     skrll 			if (mlen != (acells + icells)*4) {
    457  1.20.6.1     skrll 				printf("interrupt-map inconsistent (%d, %d)\n",
    458  1.20.6.1     skrll 				    mlen, (acells + icells)*4);
    459  1.20.6.1     skrll 				return -1;
    460  1.20.6.1     skrll 			}
    461  1.20.6.1     skrll #endif
    462  1.20.6.1     skrll 			memcpy(maskedaddr, mp, mlen);
    463  1.20.6.1     skrll 			len = OF_getprop(iparent, "interrupt-map", map,
    464  1.20.6.1     skrll 			    sizeof(map));
    465  1.20.6.1     skrll 			goto again;
    466      1.10    tsubai 		}
    467      1.10    tsubai 
    468  1.20.6.1     skrll 		mp += (acells + icells);
    469  1.20.6.1     skrll 		len -= (acells + icells) * 4;
    470      1.10    tsubai 	}
    471      1.10    tsubai 
    472      1.10    tsubai nomap:
    473      1.10    tsubai 	/*
    474      1.10    tsubai 	 * If the node has no interrupt property and the parent is a
    475      1.10    tsubai 	 * pci-bridge, use parent's interrupt.  This occurs on a PCI
    476      1.10    tsubai 	 * slot.  (e.g. AHA-3940)
    477      1.10    tsubai 	 */
    478      1.18       wiz 	memset(name, 0, sizeof(name));
    479      1.10    tsubai 	OF_getprop(parent, "name", name, sizeof(name));
    480      1.10    tsubai 	if (strcmp(name, "pci-bridge") == 0) {
    481      1.10    tsubai 		len = OF_getprop(parent, "AAPL,interrupts", intr, 4) ;
    482      1.10    tsubai 		if (len == 4)
    483      1.10    tsubai 			return len;
    484  1.20.6.1     skrll #if 0
    485      1.15    tsubai 		/*
    486      1.15    tsubai 		 * XXX I don't know what is the correct local address.
    487      1.15    tsubai 		 * XXX Use the first entry for now.
    488      1.15    tsubai 		 */
    489      1.15    tsubai 		len = OF_getprop(parent, "interrupt-map", map, sizeof(map));
    490      1.15    tsubai 		if (len >= 36) {
    491      1.15    tsubai 			addr = &map[5];
    492      1.15    tsubai 			return find_node_intr(parent, addr, intr);
    493      1.15    tsubai 		}
    494  1.20.6.1     skrll #endif
    495      1.10    tsubai 	}
    496      1.10    tsubai 
    497  1.20.6.1     skrll #if 0
    498      1.10    tsubai 	/* XXX This may be wrong... */
    499      1.10    tsubai 	len = OF_getprop(node, "interrupts", intr, 4) ;
    500      1.10    tsubai 	if (len == 4)
    501      1.10    tsubai 		return len;
    502  1.20.6.1     skrll #endif
    503      1.10    tsubai 
    504      1.10    tsubai 	return -1;
    505       1.1    tsubai }
    506