Home | History | Annotate | Line # | Download | only in pci
pci_intr_fixup.c revision 1.14.2.2
      1  1.14.2.2   thorpej /*	$NetBSD: pci_intr_fixup.c,v 1.14.2.2 2001/09/13 01:13:50 thorpej Exp $	*/
      2       1.1   thorpej 
      3       1.1   thorpej /*-
      4       1.1   thorpej  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5       1.1   thorpej  * All rights reserved.
      6       1.1   thorpej  *
      7       1.1   thorpej  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1   thorpej  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
      9       1.1   thorpej  * NASA Ames Research Center.
     10       1.1   thorpej  *
     11       1.1   thorpej  * Redistribution and use in source and binary forms, with or without
     12       1.1   thorpej  * modification, are permitted provided that the following conditions
     13       1.1   thorpej  * are met:
     14       1.1   thorpej  * 1. Redistributions of source code must retain the above copyright
     15       1.1   thorpej  *    notice, this list of conditions and the following disclaimer.
     16       1.1   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     17       1.1   thorpej  *    notice, this list of conditions and the following disclaimer in the
     18       1.1   thorpej  *    documentation and/or other materials provided with the distribution.
     19       1.1   thorpej  * 3. All advertising materials mentioning features or use of this software
     20       1.1   thorpej  *    must display the following acknowledgement:
     21       1.1   thorpej  *	This product includes software developed by the NetBSD
     22       1.1   thorpej  *	Foundation, Inc. and its contributors.
     23       1.1   thorpej  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24       1.1   thorpej  *    contributors may be used to endorse or promote products derived
     25       1.1   thorpej  *    from this software without specific prior written permission.
     26       1.1   thorpej  *
     27       1.1   thorpej  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28       1.1   thorpej  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29       1.1   thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30       1.1   thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31       1.1   thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32       1.1   thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33       1.1   thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34       1.1   thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35       1.1   thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36       1.1   thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37       1.1   thorpej  * POSSIBILITY OF SUCH DAMAGE.
     38       1.1   thorpej  */
     39       1.1   thorpej 
     40       1.1   thorpej /*
     41       1.1   thorpej  * Copyright (c) 1999, by UCHIYAMA Yasushi
     42       1.1   thorpej  * All rights reserved.
     43       1.1   thorpej  *
     44       1.1   thorpej  * Redistribution and use in source and binary forms, with or without
     45       1.1   thorpej  * modification, are permitted provided that the following conditions
     46       1.1   thorpej  * are met:
     47       1.1   thorpej  * 1. Redistributions of source code must retain the above copyright
     48       1.1   thorpej  *    notice, this list of conditions and the following disclaimer.
     49       1.1   thorpej  * 2. The name of the developer may NOT be used to endorse or promote products
     50       1.1   thorpej  *    derived from this software without specific prior written permission.
     51       1.1   thorpej  *
     52       1.1   thorpej  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     53       1.1   thorpej  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     54       1.1   thorpej  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     55       1.1   thorpej  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     56       1.1   thorpej  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     57       1.1   thorpej  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     58       1.1   thorpej  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     59       1.1   thorpej  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     60       1.1   thorpej  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     61       1.1   thorpej  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     62       1.1   thorpej  * SUCH DAMAGE.
     63       1.1   thorpej  */
     64       1.1   thorpej 
     65       1.1   thorpej /*
     66       1.1   thorpej  * PCI Interrupt Router support.
     67       1.1   thorpej  */
     68       1.1   thorpej 
     69       1.1   thorpej #include "opt_pcibios.h"
     70       1.1   thorpej 
     71       1.1   thorpej #include <sys/param.h>
     72       1.1   thorpej #include <sys/systm.h>
     73       1.1   thorpej #include <sys/kernel.h>
     74       1.1   thorpej #include <sys/malloc.h>
     75       1.1   thorpej #include <sys/queue.h>
     76       1.1   thorpej #include <sys/device.h>
     77       1.1   thorpej 
     78       1.1   thorpej #include <machine/bus.h>
     79       1.1   thorpej #include <machine/intr.h>
     80       1.1   thorpej 
     81       1.1   thorpej #include <dev/pci/pcireg.h>
     82       1.1   thorpej #include <dev/pci/pcivar.h>
     83       1.1   thorpej #include <dev/pci/pcidevs.h>
     84       1.1   thorpej 
     85       1.1   thorpej #include <i386/isa/icu.h>
     86       1.1   thorpej #include <i386/pci/pci_intr_fixup.h>
     87       1.1   thorpej #include <i386/pci/pcibios.h>
     88       1.1   thorpej 
     89       1.1   thorpej struct pciintr_link_map {
     90       1.1   thorpej 	int link;
     91       1.1   thorpej 	int clink;
     92       1.1   thorpej 	int irq;
     93       1.1   thorpej 	u_int16_t bitmap;
     94       1.1   thorpej 	int fixup_stage;
     95       1.1   thorpej 	SIMPLEQ_ENTRY(pciintr_link_map) list;
     96       1.1   thorpej };
     97       1.1   thorpej 
     98      1.10      soda pciintr_icu_tag_t pciintr_icu_tag = NULL;
     99       1.1   thorpej pciintr_icu_handle_t pciintr_icu_handle;
    100       1.1   thorpej 
    101       1.8      soda #ifdef PCIBIOS_IRQS_HINT
    102       1.8      soda int pcibios_irqs_hint = PCIBIOS_IRQS_HINT;
    103       1.8      soda #endif
    104       1.8      soda 
    105       1.7      soda struct pciintr_link_map *pciintr_link_lookup __P((int));
    106       1.1   thorpej struct pciintr_link_map *pciintr_link_alloc __P((struct pcibios_intr_routing *,
    107       1.1   thorpej 	int));
    108       1.1   thorpej struct pcibios_intr_routing *pciintr_pir_lookup __P((int, int));
    109       1.7      soda static int pciintr_bitmap_count_irq __P((int, int *));
    110       1.7      soda static int pciintr_bitmap_find_lowest_irq __P((int, int *));
    111       1.1   thorpej int	pciintr_link_init __P((void));
    112      1.10      soda #ifdef PCIBIOS_INTR_GUESS
    113      1.10      soda int	pciintr_guess_irq __P((void));
    114      1.10      soda #endif
    115       1.1   thorpej int	pciintr_link_fixup __P((void));
    116       1.1   thorpej int	pciintr_link_route __P((u_int16_t *));
    117       1.1   thorpej int	pciintr_irq_release __P((u_int16_t *));
    118       1.1   thorpej int	pciintr_header_fixup __P((pci_chipset_tag_t));
    119      1.14       mcr void	pciintr_do_header_fixup __P((pci_chipset_tag_t, pcitag_t, void*));
    120       1.1   thorpej 
    121       1.1   thorpej SIMPLEQ_HEAD(, pciintr_link_map) pciintr_link_map_list;
    122       1.1   thorpej 
    123       1.1   thorpej const struct pciintr_icu_table {
    124       1.1   thorpej 	pci_vendor_id_t	piit_vendor;
    125       1.1   thorpej 	pci_product_id_t piit_product;
    126       1.1   thorpej 	int (*piit_init) __P((pci_chipset_tag_t,
    127       1.1   thorpej 		bus_space_tag_t, pcitag_t, pciintr_icu_tag_t *,
    128       1.1   thorpej 		pciintr_icu_handle_t *));
    129       1.1   thorpej } pciintr_icu_table[] = {
    130       1.1   thorpej 	{ PCI_VENDOR_INTEL,	PCI_PRODUCT_INTEL_82371MX,
    131       1.1   thorpej 	  piix_init },
    132       1.1   thorpej 	{ PCI_VENDOR_INTEL,	PCI_PRODUCT_INTEL_82371AB_ISA,
    133       1.1   thorpej 	  piix_init },
    134       1.1   thorpej 	{ PCI_VENDOR_INTEL,	PCI_PRODUCT_INTEL_82371FB_ISA,
    135       1.1   thorpej 	  piix_init },
    136       1.1   thorpej 	{ PCI_VENDOR_INTEL,	PCI_PRODUCT_INTEL_82371SB_ISA,
    137       1.1   thorpej 	  piix_init },
    138  1.14.2.1     lukem 	{ PCI_VENDOR_INTEL,	PCI_PRODUCT_INTEL_82801BA_LPC,
    139  1.14.2.1     lukem 	  piix_init },
    140       1.1   thorpej 
    141       1.1   thorpej 	{ PCI_VENDOR_OPTI,	PCI_PRODUCT_OPTI_82C558,
    142       1.1   thorpej 	  opti82c558_init },
    143       1.1   thorpej 	{ PCI_VENDOR_OPTI,	PCI_PRODUCT_OPTI_82C700,
    144       1.1   thorpej 	  opti82c700_init },
    145       1.1   thorpej 
    146       1.1   thorpej 	{ PCI_VENDOR_VIATECH,	PCI_PRODUCT_VIATECH_VT82C586_ISA,
    147      1.11   aymeric 	  via82c586_init },
    148      1.11   aymeric 	{ PCI_VENDOR_VIATECH,	PCI_PRODUCT_VIATECH_VT82C686A_ISA,
    149      1.11   aymeric 	  via82c586_init },
    150       1.1   thorpej 
    151       1.1   thorpej 	{ PCI_VENDOR_SIS,	PCI_PRODUCT_SIS_85C503,
    152       1.1   thorpej 	  sis85c503_init },
    153      1.12       uch 
    154      1.12       uch 	{ PCI_VENDOR_AMD,	PCI_PRODUCT_AMD_PBC756_PMC,
    155      1.12       uch 	  amd756_init },
    156  1.14.2.2   thorpej 
    157  1.14.2.2   thorpej 	{ PCI_VENDOR_ALI,	PCI_PRODUCT_ALI_M1543,
    158  1.14.2.2   thorpej 	  ali1543_init },
    159       1.1   thorpej 
    160       1.1   thorpej 	{ 0,			0,
    161       1.1   thorpej 	  NULL },
    162       1.1   thorpej };
    163       1.1   thorpej 
    164       1.1   thorpej const struct pciintr_icu_table *pciintr_icu_lookup __P((pcireg_t));
    165       1.1   thorpej 
    166       1.1   thorpej const struct pciintr_icu_table *
    167       1.1   thorpej pciintr_icu_lookup(id)
    168       1.1   thorpej 	pcireg_t id;
    169       1.1   thorpej {
    170       1.1   thorpej 	const struct pciintr_icu_table *piit;
    171       1.1   thorpej 
    172       1.1   thorpej 	for (piit = pciintr_icu_table;
    173       1.1   thorpej 	     piit->piit_init != NULL;
    174       1.1   thorpej 	     piit++) {
    175       1.1   thorpej 		if (PCI_VENDOR(id) == piit->piit_vendor &&
    176       1.1   thorpej 		    PCI_PRODUCT(id) == piit->piit_product)
    177       1.1   thorpej 			return (piit);
    178       1.1   thorpej 	}
    179       1.1   thorpej 
    180       1.1   thorpej 	return (NULL);
    181       1.1   thorpej }
    182       1.1   thorpej 
    183       1.1   thorpej struct pciintr_link_map *
    184       1.7      soda pciintr_link_lookup(link)
    185       1.1   thorpej 	int link;
    186       1.1   thorpej {
    187       1.1   thorpej 	struct pciintr_link_map *l;
    188       1.1   thorpej 
    189       1.1   thorpej 	for (l = SIMPLEQ_FIRST(&pciintr_link_map_list); l != NULL;
    190       1.1   thorpej 	     l = SIMPLEQ_NEXT(l, list)) {
    191       1.1   thorpej 		if (l->link == link)
    192       1.1   thorpej 			return (l);
    193       1.1   thorpej 	}
    194       1.1   thorpej 
    195       1.1   thorpej 	return (NULL);
    196       1.1   thorpej }
    197       1.1   thorpej 
    198       1.1   thorpej struct pciintr_link_map *
    199       1.1   thorpej pciintr_link_alloc(pir, pin)
    200       1.1   thorpej 	struct pcibios_intr_routing *pir;
    201       1.1   thorpej 	int pin;
    202       1.1   thorpej {
    203       1.7      soda 	int link = pir->linkmap[pin].link, clink, irq;
    204       1.1   thorpej 	struct pciintr_link_map *l, *lstart;
    205       1.1   thorpej 
    206      1.10      soda 	if (pciintr_icu_tag != NULL) { /* compatible PCI ICU found */
    207       1.7      soda 		/*
    208      1.10      soda 		 * Get the canonical link value for this entry.
    209       1.7      soda 		 */
    210      1.10      soda 		if (pciintr_icu_getclink(pciintr_icu_tag, pciintr_icu_handle,
    211      1.10      soda 		    link, &clink) != 0) {
    212      1.10      soda 			/*
    213      1.10      soda 			 * ICU doesn't understand the link value.
    214      1.10      soda 			 * Just ignore this PIR entry.
    215      1.10      soda 			 */
    216       1.7      soda #ifdef DIAGNOSTIC
    217      1.10      soda 			printf("pciintr_link_alloc: bus %d device %d: "
    218      1.10      soda 			    "link 0x%02x invalid\n",
    219      1.10      soda 			    pir->bus, PIR_DEVFUNC_DEVICE(pir->device), link);
    220       1.7      soda #endif
    221      1.10      soda 			return (NULL);
    222      1.10      soda 		}
    223       1.7      soda 
    224       1.7      soda 		/*
    225      1.10      soda 		 * Check the link value by asking the ICU for the
    226      1.10      soda 		 * canonical link value.
    227      1.10      soda 		 * Also, determine if this PIRQ is mapped to an IRQ.
    228       1.7      soda 		 */
    229      1.10      soda 		if (pciintr_icu_get_intr(pciintr_icu_tag, pciintr_icu_handle,
    230      1.10      soda 		    clink, &irq) != 0) {
    231      1.10      soda 			/*
    232      1.10      soda 			 * ICU doesn't understand the canonical link value.
    233      1.10      soda 			 * Just ignore this PIR entry.
    234      1.10      soda 			 */
    235       1.7      soda #ifdef DIAGNOSTIC
    236      1.10      soda 			printf("pciintr_link_alloc: "
    237      1.10      soda 			    "bus %d device %d link 0x%02x: "
    238      1.10      soda 			    "PIRQ 0x%02x invalid\n",
    239      1.10      soda 			    pir->bus, PIR_DEVFUNC_DEVICE(pir->device), link,
    240      1.10      soda 			    clink);
    241       1.7      soda #endif
    242      1.10      soda 			return (NULL);
    243      1.10      soda 		}
    244       1.7      soda 	}
    245       1.7      soda 
    246       1.1   thorpej 	l = malloc(sizeof(*l), M_DEVBUF, M_NOWAIT);
    247       1.1   thorpej 	if (l == NULL)
    248       1.1   thorpej 		panic("pciintr_link_alloc");
    249       1.1   thorpej 
    250       1.1   thorpej 	memset(l, 0, sizeof(*l));
    251       1.1   thorpej 
    252       1.7      soda 	l->link = link;
    253       1.1   thorpej 	l->bitmap = pir->linkmap[pin].bitmap;
    254      1.10      soda 	if (pciintr_icu_tag != NULL) { /* compatible PCI ICU found */
    255      1.10      soda 		l->clink = clink;
    256      1.10      soda 		l->irq = irq; /* maybe I386_PCI_INTERRUPT_LINE_NO_CONNECTION */
    257      1.10      soda 	} else {
    258      1.10      soda 		l->clink = link; /* only for PCIBIOSVERBOSE diagnostic */
    259      1.10      soda 		l->irq = I386_PCI_INTERRUPT_LINE_NO_CONNECTION;
    260      1.10      soda 	}
    261       1.1   thorpej 
    262       1.1   thorpej 	lstart = SIMPLEQ_FIRST(&pciintr_link_map_list);
    263       1.1   thorpej 	if (lstart == NULL || lstart->link < l->link)
    264       1.1   thorpej 		SIMPLEQ_INSERT_TAIL(&pciintr_link_map_list, l, list);
    265       1.1   thorpej 	else
    266       1.1   thorpej 		SIMPLEQ_INSERT_HEAD(&pciintr_link_map_list, l, list);
    267       1.1   thorpej 
    268       1.1   thorpej 	return (l);
    269       1.1   thorpej }
    270       1.1   thorpej 
    271       1.1   thorpej struct pcibios_intr_routing *
    272       1.1   thorpej pciintr_pir_lookup(bus, device)
    273       1.1   thorpej 	int bus, device;
    274       1.1   thorpej {
    275       1.1   thorpej 	struct pcibios_intr_routing *pir;
    276       1.1   thorpej 	int entry;
    277       1.1   thorpej 
    278       1.1   thorpej 	if (pcibios_pir_table == NULL)
    279       1.1   thorpej 		return (NULL);
    280       1.1   thorpej 
    281       1.1   thorpej 	for (entry = 0; entry < pcibios_pir_table_nentries; entry++) {
    282       1.1   thorpej 		pir = &pcibios_pir_table[entry];
    283       1.7      soda 		if (pir->bus == bus &&
    284       1.7      soda 		    PIR_DEVFUNC_DEVICE(pir->device) == device)
    285       1.1   thorpej 			return (pir);
    286       1.1   thorpej 	}
    287       1.1   thorpej 
    288       1.1   thorpej 	return (NULL);
    289       1.1   thorpej }
    290       1.1   thorpej 
    291       1.7      soda static int
    292       1.7      soda pciintr_bitmap_count_irq(irq_bitmap, irqp)
    293       1.7      soda 	int irq_bitmap, *irqp;
    294       1.7      soda {
    295       1.7      soda 	int i, bit, count = 0, irq = I386_PCI_INTERRUPT_LINE_NO_CONNECTION;
    296       1.7      soda 
    297       1.7      soda 	if (irq_bitmap != 0) {
    298       1.7      soda 		for (i = 0, bit = 1; i < 16; i++, bit <<= 1) {
    299       1.7      soda 			if (irq_bitmap & bit) {
    300       1.7      soda 				irq = i;
    301       1.7      soda 				count++;
    302       1.7      soda 			}
    303       1.7      soda 		}
    304       1.7      soda 	}
    305       1.7      soda 	*irqp = irq;
    306       1.7      soda 	return (count);
    307       1.7      soda }
    308       1.7      soda 
    309       1.7      soda static int
    310       1.7      soda pciintr_bitmap_find_lowest_irq(irq_bitmap, irqp)
    311       1.7      soda 	int irq_bitmap, *irqp;
    312       1.7      soda {
    313       1.7      soda 	int i, bit;
    314       1.7      soda 
    315       1.7      soda 	if (irq_bitmap != 0) {
    316       1.7      soda 		for (i = 0, bit = 1; i < 16; i++, bit <<= 1) {
    317       1.7      soda 			if (irq_bitmap & bit) {
    318       1.7      soda 				*irqp = i;
    319       1.7      soda 				return (1); /* found */
    320       1.7      soda 			}
    321       1.7      soda 		}
    322       1.7      soda 	}
    323       1.7      soda 	return (0); /* not found */
    324       1.7      soda }
    325       1.7      soda 
    326       1.1   thorpej int
    327       1.1   thorpej pciintr_link_init()
    328       1.1   thorpej {
    329      1.10      soda 	int entry, pin, link;
    330       1.1   thorpej 	struct pcibios_intr_routing *pir;
    331       1.1   thorpej 	struct pciintr_link_map *l;
    332       1.1   thorpej 
    333       1.1   thorpej 	if (pcibios_pir_table == NULL) {
    334       1.1   thorpej 		/* No PIR table; can't do anything. */
    335       1.1   thorpej 		printf("pciintr_link_init: no PIR table\n");
    336       1.1   thorpej 		return (1);
    337       1.1   thorpej 	}
    338       1.1   thorpej 
    339       1.1   thorpej 	SIMPLEQ_INIT(&pciintr_link_map_list);
    340       1.1   thorpej 
    341       1.1   thorpej 	for (entry = 0; entry < pcibios_pir_table_nentries; entry++) {
    342       1.1   thorpej 		pir = &pcibios_pir_table[entry];
    343       1.7      soda 		for (pin = 0; pin < PCI_INTERRUPT_PIN_MAX; pin++) {
    344       1.1   thorpej 			link = pir->linkmap[pin].link;
    345       1.1   thorpej 			if (link == 0) {
    346       1.1   thorpej 				/* No connection for this pin. */
    347       1.1   thorpej 				continue;
    348       1.1   thorpej 			}
    349       1.1   thorpej 			/*
    350       1.1   thorpej 			 * Multiple devices may be wired to the same
    351       1.1   thorpej 			 * interrupt; check to see if we've seen this
    352       1.1   thorpej 			 * one already.  If not, allocate a new link
    353       1.1   thorpej 			 * map entry and stuff it in the map.
    354       1.1   thorpej 			 */
    355       1.7      soda 			l = pciintr_link_lookup(link);
    356       1.7      soda 			if (l == NULL) {
    357       1.1   thorpej 				(void) pciintr_link_alloc(pir, pin);
    358       1.7      soda 			} else if (pir->linkmap[pin].bitmap != l->bitmap) {
    359       1.7      soda 				/*
    360       1.7      soda 				 * violates PCI IRQ Routing Table Specification
    361       1.7      soda 				 */
    362       1.7      soda #ifdef DIAGNOSTIC
    363       1.7      soda 				printf("pciintr_link_init: "
    364       1.7      soda 				    "bus %d device %d link 0x%02x: "
    365       1.7      soda 				    "bad irq bitmap 0x%04x, "
    366       1.7      soda 				    "should be 0x%04x\n",
    367       1.7      soda 				    pir->bus, PIR_DEVFUNC_DEVICE(pir->device),
    368       1.7      soda 				    link, pir->linkmap[pin].bitmap, l->bitmap);
    369       1.7      soda #endif
    370       1.7      soda 				/* safer value. */
    371       1.7      soda 				l->bitmap &= pir->linkmap[pin].bitmap;
    372       1.7      soda 				/* XXX - or, should ignore this entry? */
    373       1.7      soda 			}
    374       1.1   thorpej 		}
    375       1.1   thorpej 	}
    376       1.1   thorpej 
    377      1.10      soda 	return (0);
    378      1.10      soda }
    379      1.10      soda 
    380      1.10      soda #ifdef PCIBIOS_INTR_GUESS
    381      1.10      soda /*
    382      1.10      soda  * No compatible PCI ICU found.
    383      1.10      soda  * Hopes the BIOS already setup the ICU.
    384      1.10      soda  */
    385      1.10      soda int
    386      1.10      soda pciintr_guess_irq()
    387      1.10      soda {
    388      1.10      soda 	struct pciintr_link_map *l;
    389      1.10      soda 	int irq, guessed = 0;
    390      1.10      soda 
    391      1.10      soda 	/*
    392      1.10      soda 	 * Stage 1: If only one IRQ is available for the link, use it.
    393      1.10      soda 	 */
    394      1.10      soda 	for (l = SIMPLEQ_FIRST(&pciintr_link_map_list); l != NULL;
    395      1.10      soda 	     l = SIMPLEQ_NEXT(l, list)) {
    396      1.10      soda 		if (l->irq != I386_PCI_INTERRUPT_LINE_NO_CONNECTION)
    397      1.10      soda 			continue;
    398      1.10      soda 		if (pciintr_bitmap_count_irq(l->bitmap, &irq) == 1) {
    399      1.10      soda 			l->irq = irq;
    400      1.10      soda 			l->fixup_stage = 1;
    401      1.10      soda #ifdef PCIINTR_DEBUG
    402      1.10      soda 			printf("pciintr_guess_irq (stage 1): "
    403      1.10      soda 			    "guessing PIRQ 0x%02x to be IRQ %d\n",
    404      1.10      soda 			    l->clink, l->irq);
    405      1.10      soda #endif
    406      1.10      soda 			guessed = 1;
    407      1.10      soda 		}
    408      1.10      soda 	}
    409      1.10      soda 
    410      1.10      soda 	return (guessed ? 0 : -1);
    411       1.1   thorpej }
    412      1.10      soda #endif /* PCIBIOS_INTR_GUESS */
    413       1.1   thorpej 
    414       1.1   thorpej int
    415       1.1   thorpej pciintr_link_fixup()
    416       1.1   thorpej {
    417       1.1   thorpej 	struct pciintr_link_map *l;
    418       1.7      soda 	int irq;
    419       1.7      soda 	u_int16_t pciirq = 0;
    420       1.1   thorpej 
    421       1.1   thorpej 	/*
    422       1.1   thorpej 	 * First stage: Attempt to connect PIRQs which aren't
    423       1.1   thorpej 	 * yet connected.
    424       1.1   thorpej 	 */
    425       1.1   thorpej 	for (l = SIMPLEQ_FIRST(&pciintr_link_map_list); l != NULL;
    426       1.1   thorpej 	     l = SIMPLEQ_NEXT(l, list)) {
    427       1.7      soda 		if (l->irq != I386_PCI_INTERRUPT_LINE_NO_CONNECTION) {
    428       1.1   thorpej 			/*
    429       1.7      soda 			 * Interrupt is already connected.  Don't do
    430       1.7      soda 			 * anything to it.
    431       1.7      soda 			 * In this case, l->fixup_stage == 0.
    432       1.1   thorpej 			 */
    433       1.7      soda 			pciirq |= 1 << l->irq;
    434       1.1   thorpej #ifdef PCIINTR_DEBUG
    435       1.7      soda 			printf("pciintr_link_fixup: PIRQ 0x%02x already "
    436       1.7      soda 			    "connected to IRQ %d\n", l->clink, l->irq);
    437       1.1   thorpej #endif
    438       1.1   thorpej 			continue;
    439       1.1   thorpej 		}
    440       1.1   thorpej 		/*
    441       1.7      soda 		 * Interrupt isn't connected.  Attempt to assign it to an IRQ.
    442       1.1   thorpej 		 */
    443       1.1   thorpej #ifdef PCIINTR_DEBUG
    444       1.7      soda 		printf("pciintr_link_fixup: PIRQ 0x%02x not connected",
    445       1.7      soda 		    l->clink);
    446       1.1   thorpej #endif
    447       1.7      soda 		/*
    448       1.7      soda 		 * Just do the easy case now; we'll defer the harder ones
    449       1.7      soda 		 * to Stage 2.
    450       1.7      soda 		 */
    451       1.7      soda 		if (pciintr_bitmap_count_irq(l->bitmap, &irq) == 1) {
    452       1.1   thorpej 			l->irq = irq;
    453       1.7      soda 			l->fixup_stage = 1;
    454       1.1   thorpej 			pciirq |= 1 << irq;
    455       1.1   thorpej #ifdef PCIINTR_DEBUG
    456       1.7      soda 			printf(", assigning IRQ %d", l->irq);
    457       1.1   thorpej #endif
    458       1.1   thorpej 		}
    459       1.7      soda #ifdef PCIINTR_DEBUG
    460       1.7      soda 		printf("\n");
    461       1.7      soda #endif
    462       1.1   thorpej 	}
    463       1.4  augustss 
    464       1.1   thorpej 	/*
    465       1.1   thorpej 	 * Stage 2: Attempt to connect PIRQs which we didn't
    466       1.1   thorpej 	 * connect in Stage 1.
    467       1.1   thorpej 	 */
    468       1.1   thorpej 	for (l = SIMPLEQ_FIRST(&pciintr_link_map_list); l != NULL;
    469       1.1   thorpej 	     l = SIMPLEQ_NEXT(l, list)) {
    470       1.7      soda 		if (l->irq != I386_PCI_INTERRUPT_LINE_NO_CONNECTION)
    471       1.5       uch 			continue;
    472       1.7      soda 		if (pciintr_bitmap_find_lowest_irq(l->bitmap & pciirq,
    473       1.7      soda 		    &l->irq)) {
    474       1.7      soda 			/*
    475       1.7      soda 			 * This IRQ is a valid PCI IRQ already
    476       1.7      soda 			 * connected to another PIRQ, and also an
    477       1.7      soda 			 * IRQ our PIRQ can use; connect it up!
    478       1.7      soda 			 */
    479       1.7      soda 			l->fixup_stage = 2;
    480       1.1   thorpej #ifdef PCIINTR_DEBUG
    481       1.7      soda 			printf("pciintr_link_fixup (stage 2): "
    482       1.7      soda 			       "assigning IRQ %d to PIRQ 0x%02x\n",
    483       1.7      soda 			       l->irq, l->clink);
    484       1.1   thorpej #endif
    485       1.1   thorpej 		}
    486       1.1   thorpej 	}
    487       1.1   thorpej 
    488       1.5       uch #ifdef PCIBIOS_IRQS_HINT
    489       1.1   thorpej 	/*
    490       1.5       uch 	 * Stage 3: The worst case. I need configuration hint that
    491       1.5       uch 	 * user supplied a mask for the PCI irqs
    492       1.1   thorpej 	 */
    493       1.5       uch 	for (l = SIMPLEQ_FIRST(&pciintr_link_map_list); l != NULL;
    494       1.5       uch 	     l = SIMPLEQ_NEXT(l, list)) {
    495       1.7      soda 		if (l->irq != I386_PCI_INTERRUPT_LINE_NO_CONNECTION)
    496       1.5       uch 			continue;
    497       1.7      soda 		if (pciintr_bitmap_find_lowest_irq(
    498       1.8      soda 		    l->bitmap & pcibios_irqs_hint, &l->irq)) {
    499       1.7      soda 			l->fixup_stage = 3;
    500       1.5       uch #ifdef PCIINTR_DEBUG
    501       1.7      soda 			printf("pciintr_link_fixup (stage 3): "
    502       1.7      soda 			       "assigning IRQ %d to PIRQ 0x%02x\n",
    503       1.7      soda 			       l->irq, l->clink);
    504       1.5       uch #endif
    505       1.5       uch 		}
    506       1.5       uch 	}
    507       1.5       uch #endif /* PCIBIOS_IRQS_HINT */
    508       1.1   thorpej 
    509       1.1   thorpej 	return (0);
    510       1.1   thorpej }
    511       1.1   thorpej 
    512       1.1   thorpej int
    513       1.1   thorpej pciintr_link_route(pciirq)
    514       1.1   thorpej 	u_int16_t *pciirq;
    515       1.1   thorpej {
    516       1.1   thorpej 	struct pciintr_link_map *l;
    517       1.1   thorpej 	int rv = 0;
    518       1.1   thorpej 
    519       1.1   thorpej 	*pciirq = 0;
    520       1.1   thorpej 
    521       1.1   thorpej 	for (l = SIMPLEQ_FIRST(&pciintr_link_map_list); l != NULL;
    522       1.1   thorpej 	     l = SIMPLEQ_NEXT(l, list)) {
    523       1.7      soda 		if (l->fixup_stage == 0) {
    524       1.7      soda 			if (l->irq == I386_PCI_INTERRUPT_LINE_NO_CONNECTION) {
    525       1.7      soda 				/* Appropriate interrupt was not found. */
    526       1.7      soda #ifdef DIAGNOSTIC
    527       1.7      soda 				printf("pciintr_link_route: "
    528       1.7      soda 				    "PIRQ 0x%02x: no IRQ, try "
    529       1.7      soda 				    "\"options PCIBIOS_IRQS_HINT=0x%04x\"\n",
    530       1.7      soda 				    l->clink,
    531       1.7      soda 				    /* suggest irq 9/10/11, if possible */
    532       1.7      soda 				    (l->bitmap & 0x0e00) ? (l->bitmap & 0x0e00)
    533       1.7      soda 				    : l->bitmap);
    534       1.7      soda #endif
    535       1.7      soda 			} else {
    536       1.7      soda 				/* BIOS setting has no problem */
    537       1.7      soda #ifdef PCIINTR_DEBUG
    538       1.7      soda 				printf("pciintr_link_route: "
    539       1.7      soda 				    "route of PIRQ 0x%02x -> "
    540       1.7      soda 				    "IRQ %d preserved BIOS setting\n",
    541       1.7      soda 				    l->clink, l->irq);
    542       1.7      soda #endif
    543       1.7      soda 				*pciirq |= (1 << l->irq);
    544       1.7      soda 			}
    545       1.7      soda 			continue; /* nothing to do. */
    546       1.7      soda 		}
    547       1.7      soda 
    548       1.1   thorpej 		if (pciintr_icu_set_intr(pciintr_icu_tag, pciintr_icu_handle,
    549       1.1   thorpej 					 l->clink, l->irq) != 0 ||
    550       1.7      soda 		    pciintr_icu_set_trigger(pciintr_icu_tag,
    551       1.7      soda 					    pciintr_icu_handle,
    552       1.1   thorpej 					    l->irq, IST_LEVEL) != 0) {
    553       1.7      soda 			printf("pciintr_link_route: route of PIRQ 0x%02x -> "
    554       1.7      soda 			    "IRQ %d failed\n", l->clink, l->irq);
    555       1.1   thorpej 			rv = 1;
    556       1.1   thorpej 		} else {
    557       1.1   thorpej 			/*
    558       1.1   thorpej 			 * Succssfully routed interrupt.  Mark this as
    559       1.1   thorpej 			 * a PCI interrupt.
    560       1.1   thorpej 			 */
    561       1.1   thorpej 			*pciirq |= (1 << l->irq);
    562       1.1   thorpej 		}
    563       1.1   thorpej 	}
    564       1.1   thorpej 
    565       1.1   thorpej 	return (rv);
    566       1.1   thorpej }
    567       1.1   thorpej 
    568       1.1   thorpej int
    569       1.1   thorpej pciintr_irq_release(pciirq)
    570       1.1   thorpej 	u_int16_t *pciirq;
    571       1.1   thorpej {
    572       1.7      soda 	int i, bit;
    573       1.1   thorpej 
    574       1.7      soda 	for (i = 0, bit = 1; i < 16; i++, bit <<= 1) {
    575       1.7      soda 		if ((*pciirq & bit) == 0)
    576       1.1   thorpej 			(void) pciintr_icu_set_trigger(pciintr_icu_tag,
    577       1.1   thorpej 			    pciintr_icu_handle, i, IST_EDGE);
    578       1.1   thorpej 	}
    579       1.1   thorpej 
    580       1.1   thorpej 	return (0);
    581       1.1   thorpej }
    582       1.1   thorpej 
    583       1.1   thorpej int
    584       1.1   thorpej pciintr_header_fixup(pc)
    585       1.1   thorpej 	pci_chipset_tag_t pc;
    586       1.1   thorpej {
    587       1.7      soda 	PCIBIOS_PRINTV(("------------------------------------------\n"));
    588       1.7      soda 	PCIBIOS_PRINTV(("  device vendor product pin PIRQ IRQ stage\n"));
    589       1.7      soda 	PCIBIOS_PRINTV(("------------------------------------------\n"));
    590      1.14       mcr 	pci_device_foreach(pc, pcibios_max_bus, pciintr_do_header_fixup, NULL);
    591       1.7      soda 	PCIBIOS_PRINTV(("------------------------------------------\n"));
    592       1.1   thorpej 
    593       1.5       uch 	return (0);
    594       1.5       uch }
    595       1.1   thorpej 
    596       1.5       uch void
    597      1.14       mcr pciintr_do_header_fixup(pc, tag, context)
    598       1.5       uch 	pci_chipset_tag_t pc;
    599       1.5       uch 	pcitag_t tag;
    600      1.14       mcr 	void *context;
    601       1.5       uch {
    602       1.5       uch 	struct pcibios_intr_routing *pir;
    603       1.5       uch 	struct pciintr_link_map *l;
    604       1.5       uch 	int pin, irq, link;
    605       1.5       uch 	int bus, device, function;
    606       1.5       uch 	pcireg_t intr, id;
    607       1.5       uch 
    608       1.5       uch 	pci_decompose_tag(pc, tag, &bus, &device, &function);
    609       1.5       uch 	id = pci_conf_read(pc, tag, PCI_ID_REG);
    610       1.5       uch 
    611       1.5       uch 	intr = pci_conf_read(pc, tag, PCI_INTERRUPT_REG);
    612       1.5       uch 	pin = PCI_INTERRUPT_PIN(intr);
    613       1.5       uch 	irq = PCI_INTERRUPT_LINE(intr);
    614       1.1   thorpej 
    615      1.14       mcr #if 0
    616       1.5       uch 	if (pin == 0) {
    617       1.5       uch 		/*
    618       1.5       uch 		 * No interrupt used.
    619       1.5       uch 		 */
    620       1.5       uch 		return;
    621       1.5       uch 	}
    622      1.14       mcr #endif
    623       1.1   thorpej 
    624       1.5       uch 	pir = pciintr_pir_lookup(bus, device);
    625       1.5       uch 	if (pir == NULL || (link = pir->linkmap[pin - 1].link) == 0) {
    626       1.5       uch 		/*
    627       1.5       uch 		 * Interrupt not connected; no
    628       1.5       uch 		 * need to change.
    629       1.5       uch 		 */
    630       1.5       uch 		return;
    631       1.5       uch 	}
    632       1.1   thorpej 
    633       1.7      soda 	l = pciintr_link_lookup(link);
    634       1.5       uch 	if (l == NULL) {
    635       1.7      soda #ifdef PCIINTR_DEBUG
    636       1.5       uch 		/*
    637       1.7      soda 		 * No link map entry.
    638       1.7      soda 		 * Probably pciintr_icu_getclink() or pciintr_icu_get_intr()
    639       1.7      soda 		 * was failed.
    640       1.5       uch 		 */
    641       1.5       uch 		printf("pciintr_header_fixup: no entry for link 0x%02x "
    642       1.5       uch 		       "(%d:%d:%d:%c)\n", link, bus, device, function,
    643       1.5       uch 		       '@' + pin);
    644       1.7      soda #endif
    645       1.5       uch 		return;
    646       1.1   thorpej 	}
    647       1.7      soda 
    648       1.7      soda #ifdef PCIBIOSVERBOSE
    649       1.7      soda 	if (pcibiosverbose) {
    650       1.7      soda 		printf("%03d:%02d:%d 0x%04x 0x%04x   %c  0x%02x",
    651       1.7      soda 		    bus, device, function, PCI_VENDOR(id), PCI_PRODUCT(id),
    652       1.7      soda 		    '@' + pin, l->clink);
    653       1.7      soda 		if (l->irq == I386_PCI_INTERRUPT_LINE_NO_CONNECTION)
    654       1.7      soda 			printf("   -");
    655       1.7      soda 		else
    656       1.7      soda 			printf(" %3d", l->irq);
    657       1.7      soda 		printf("  %d   ", l->fixup_stage);
    658       1.7      soda 	}
    659       1.7      soda #endif
    660       1.5       uch 
    661       1.5       uch 	/*
    662       1.5       uch 	 * IRQs 14 and 15 are reserved for PCI IDE interrupts; don't muck
    663       1.5       uch 	 * with them.
    664       1.5       uch 	 */
    665       1.7      soda 	if (irq == 14 || irq == 15) {
    666       1.7      soda 		PCIBIOS_PRINTV((" WARNING: ignored\n"));
    667       1.7      soda 		return;
    668       1.7      soda 	}
    669       1.7      soda 
    670       1.7      soda 	if (l->irq == I386_PCI_INTERRUPT_LINE_NO_CONNECTION) {
    671       1.7      soda 		/* Appropriate interrupt was not found. */
    672      1.10      soda 		if (pciintr_icu_tag == NULL &&
    673      1.10      soda 		    irq != 0 && irq != I386_PCI_INTERRUPT_LINE_NO_CONNECTION) {
    674      1.10      soda 			/*
    675      1.10      soda 			 * Do not print warning,
    676      1.10      soda 			 * if no compatible PCI ICU found,
    677      1.10      soda 			 * but the irq is already assigned by BIOS.
    678      1.10      soda 			 */
    679      1.10      soda 			PCIBIOS_PRINTV(("\n"));
    680      1.10      soda 		} else {
    681      1.10      soda 			PCIBIOS_PRINTV((" WARNING: missing IRQ\n"));
    682      1.10      soda 		}
    683       1.5       uch 		return;
    684       1.7      soda 	}
    685       1.7      soda 
    686       1.7      soda 	if (l->irq == irq) {
    687       1.7      soda 		/* don't have to reconfigure */
    688       1.7      soda 		PCIBIOS_PRINTV((" already assigned\n"));
    689       1.7      soda 		return;
    690       1.7      soda 	}
    691       1.1   thorpej 
    692       1.7      soda 	if (irq == 0 || irq == I386_PCI_INTERRUPT_LINE_NO_CONNECTION) {
    693       1.7      soda 		PCIBIOS_PRINTV((" fixed up\n"));
    694       1.7      soda 	} else {
    695       1.7      soda 		/* routed by BIOS, but inconsistent */
    696       1.7      soda #ifdef PCIBIOS_INTR_FIXUP_FORCE
    697       1.7      soda 		/* believe PCI IRQ Routing table */
    698       1.9      soda 		PCIBIOS_PRINTV((" WARNING: overriding irq %d\n", irq));
    699       1.7      soda #else
    700      1.10      soda 		/* believe PCI Interrupt Configuration Register (default) */
    701       1.9      soda 		PCIBIOS_PRINTV((" WARNING: preserving irq %d\n", irq));
    702       1.7      soda 		return;
    703       1.1   thorpej #endif
    704       1.7      soda 	}
    705       1.1   thorpej 
    706       1.5       uch 	intr &= ~(PCI_INTERRUPT_LINE_MASK << PCI_INTERRUPT_LINE_SHIFT);
    707       1.5       uch 	intr |= (l->irq << PCI_INTERRUPT_LINE_SHIFT);
    708       1.5       uch 	pci_conf_write(pc, tag, PCI_INTERRUPT_REG, intr);
    709       1.1   thorpej }
    710       1.1   thorpej 
    711       1.1   thorpej int
    712       1.1   thorpej pci_intr_fixup(pc, iot, pciirq)
    713       1.1   thorpej 	pci_chipset_tag_t pc;
    714       1.1   thorpej 	bus_space_tag_t iot;
    715       1.1   thorpej 	u_int16_t *pciirq;
    716       1.1   thorpej {
    717       1.1   thorpej 	const struct pciintr_icu_table *piit = NULL;
    718       1.1   thorpej 	pcitag_t icutag;
    719       1.1   thorpej 	pcireg_t icuid;
    720       1.1   thorpej 
    721       1.1   thorpej 	/*
    722       1.1   thorpej 	 * Attempt to initialize our PCI interrupt router.  If
    723       1.1   thorpej 	 * the PIR Table is present in ROM, use the location
    724       1.1   thorpej 	 * specified by the PIR Table, and use the compat ID,
    725       1.1   thorpej 	 * if present.  Otherwise, we have to look for the router
    726       1.1   thorpej 	 * ourselves (the PCI-ISA bridge).
    727      1.13   kanaoka 	 *
    728      1.13   kanaoka 	 * A number of buggy BIOS implementations leave the router
    729      1.13   kanaoka 	 * entry as 000:00:0, which is typically not the correct
    730      1.13   kanaoka 	 * device/function.  If the router device address is set to
    731      1.13   kanaoka 	 * this value, and the compatible router entry is undefined
    732      1.13   kanaoka 	 * (zero is the correct value to indicate undefined), then we
    733      1.13   kanaoka 	 * work on the basis it is most likely an error, and search
    734      1.13   kanaoka 	 * the entire device-space of bus 0 (but obviously starting
    735      1.13   kanaoka 	 * with 000:00:0, in case that really is the right one).
    736       1.1   thorpej 	 */
    737      1.13   kanaoka 	if (pcibios_pir_header.signature != 0 &&
    738      1.13   kanaoka 	    (pcibios_pir_header.router_bus != 0 ||
    739      1.13   kanaoka 	     PIR_DEVFUNC_DEVICE(pcibios_pir_header.router_devfunc) != 0 ||
    740      1.13   kanaoka 	     PIR_DEVFUNC_FUNCTION(pcibios_pir_header.router_devfunc) != 0 ||
    741      1.13   kanaoka 	     pcibios_pir_header.compat_router != 0)) {
    742       1.1   thorpej 		icutag = pci_make_tag(pc, pcibios_pir_header.router_bus,
    743       1.7      soda 		    PIR_DEVFUNC_DEVICE(pcibios_pir_header.router_devfunc),
    744       1.7      soda 		    PIR_DEVFUNC_FUNCTION(pcibios_pir_header.router_devfunc));
    745       1.1   thorpej 		icuid = pcibios_pir_header.compat_router;
    746       1.1   thorpej 		if (icuid == 0 ||
    747       1.1   thorpej 		    (piit = pciintr_icu_lookup(icuid)) == NULL) {
    748       1.1   thorpej 			/*
    749       1.1   thorpej 			 * No compat ID, or don't know the compat ID?  Read
    750       1.1   thorpej 			 * it from the configuration header.
    751       1.1   thorpej 			 */
    752       1.1   thorpej 			icuid = pci_conf_read(pc, icutag, PCI_ID_REG);
    753       1.1   thorpej 		}
    754       1.1   thorpej 		if (piit == NULL)
    755       1.1   thorpej 			piit = pciintr_icu_lookup(icuid);
    756       1.1   thorpej 	} else {
    757       1.1   thorpej 		int device, maxdevs = pci_bus_maxdevs(pc, 0);
    758       1.1   thorpej 
    759       1.1   thorpej 		/*
    760       1.1   thorpej 		 * Search configuration space for a known interrupt
    761       1.1   thorpej 		 * router.
    762       1.1   thorpej 		 */
    763       1.1   thorpej 		for (device = 0; device < maxdevs; device++) {
    764      1.13   kanaoka 			const struct pci_quirkdata *qd;
    765      1.13   kanaoka 			int function, nfuncs;
    766      1.13   kanaoka 			pcireg_t bhlcr;
    767      1.13   kanaoka 
    768       1.1   thorpej 			icutag = pci_make_tag(pc, 0, device, 0);
    769       1.1   thorpej 			icuid = pci_conf_read(pc, icutag, PCI_ID_REG);
    770       1.1   thorpej 
    771       1.1   thorpej 			/* Invalid vendor ID value? */
    772       1.1   thorpej 			if (PCI_VENDOR(icuid) == PCI_VENDOR_INVALID)
    773       1.1   thorpej 				continue;
    774       1.1   thorpej 			/* XXX Not invalid, but we've done this ~forever. */
    775       1.1   thorpej 			if (PCI_VENDOR(icuid) == 0)
    776       1.1   thorpej 				continue;
    777       1.1   thorpej 
    778      1.13   kanaoka 			qd = pci_lookup_quirkdata(PCI_VENDOR(icuid),
    779      1.13   kanaoka 			    PCI_PRODUCT(icuid));
    780      1.13   kanaoka 
    781      1.13   kanaoka 			bhlcr = pci_conf_read(pc, icutag, PCI_BHLC_REG);
    782      1.13   kanaoka 			if (PCI_HDRTYPE_MULTIFN(bhlcr) ||
    783      1.13   kanaoka 			    (qd != NULL &&
    784      1.13   kanaoka 			     (qd->quirks & PCI_QUIRK_MULTIFUNCTION) != 0))
    785      1.13   kanaoka 				nfuncs = 8;
    786      1.13   kanaoka 			else
    787      1.13   kanaoka 				nfuncs = 1;
    788      1.13   kanaoka 
    789      1.13   kanaoka 			for (function = 0; function < nfuncs; function++) {
    790      1.13   kanaoka 				icutag = pci_make_tag(pc, 0, device, function);
    791      1.13   kanaoka 				icuid = pci_conf_read(pc, icutag, PCI_ID_REG);
    792      1.13   kanaoka 
    793      1.13   kanaoka 				/* Invalid vendor ID value? */
    794      1.13   kanaoka 				if (PCI_VENDOR(icuid) == PCI_VENDOR_INVALID)
    795      1.13   kanaoka 					continue;
    796      1.13   kanaoka 				/* Not invalid, but we've done this ~forever */
    797      1.13   kanaoka 				if (PCI_VENDOR(icuid) == 0)
    798      1.13   kanaoka 					continue;
    799      1.13   kanaoka 
    800      1.13   kanaoka 				piit = pciintr_icu_lookup(icuid);
    801      1.13   kanaoka 				if (piit != NULL)
    802      1.13   kanaoka 					goto found;
    803      1.13   kanaoka 			}
    804       1.1   thorpej 		}
    805      1.13   kanaoka 
    806      1.13   kanaoka 		/*
    807      1.13   kanaoka 		 * Invalidate the ICU ID.  If we failed to find the
    808      1.13   kanaoka 		 * interrupt router (piit == NULL) we don't want to
    809      1.13   kanaoka 		 * display a spurious device address below containing
    810      1.13   kanaoka 		 * the product information of the last device we
    811      1.13   kanaoka 		 * looked at.
    812      1.13   kanaoka 		 */
    813      1.13   kanaoka 		icuid = 0;
    814  1.14.2.1     lukem found:;
    815       1.1   thorpej 	}
    816       1.1   thorpej 
    817       1.1   thorpej 	if (piit == NULL) {
    818      1.10      soda 		printf("pci_intr_fixup: no compatible PCI ICU found");
    819      1.10      soda 		if (pcibios_pir_header.signature != 0 && icuid != 0)
    820      1.10      soda 			printf(": ICU vendor 0x%04x product 0x%04x",
    821      1.10      soda 			    PCI_VENDOR(icuid), PCI_PRODUCT(icuid));
    822      1.10      soda 		printf("\n");
    823      1.10      soda #ifdef PCIBIOS_INTR_GUESS
    824      1.10      soda 		if (pciintr_link_init())
    825      1.10      soda 			return (-1);	/* non-fatal */
    826      1.10      soda 		if (pciintr_guess_irq())
    827      1.10      soda 			return (-1);	/* non-fatal */
    828      1.10      soda 		if (pciintr_header_fixup(pc))
    829      1.10      soda 			return (1);	/* fatal */
    830      1.10      soda 		return (0);		/* success! */
    831      1.10      soda #else
    832       1.1   thorpej 		return (-1);		/* non-fatal */
    833      1.10      soda #endif
    834       1.1   thorpej 	}
    835       1.1   thorpej 
    836       1.1   thorpej 	/*
    837       1.1   thorpej 	 * Initialize the PCI ICU.
    838       1.1   thorpej 	 */
    839       1.1   thorpej 	if ((*piit->piit_init)(pc, iot, icutag, &pciintr_icu_tag,
    840       1.1   thorpej 	    &pciintr_icu_handle) != 0)
    841       1.1   thorpej 		return (-1);		/* non-fatal */
    842       1.1   thorpej 
    843       1.1   thorpej 	/*
    844       1.1   thorpej 	 * Initialize the PCI interrupt link map.
    845       1.1   thorpej 	 */
    846       1.1   thorpej 	if (pciintr_link_init())
    847       1.1   thorpej 		return (-1);		/* non-fatal */
    848       1.1   thorpej 
    849       1.1   thorpej 	/*
    850       1.1   thorpej 	 * Fix up the link->IRQ mappings.
    851       1.1   thorpej 	 */
    852       1.1   thorpej 	if (pciintr_link_fixup() != 0)
    853       1.1   thorpej 		return (-1);		/* non-fatal */
    854       1.1   thorpej 
    855       1.1   thorpej 	/*
    856       1.1   thorpej 	 * Now actually program the PCI ICU with the new
    857       1.1   thorpej 	 * routing information.
    858       1.1   thorpej 	 */
    859       1.1   thorpej 	if (pciintr_link_route(pciirq) != 0)
    860       1.1   thorpej 		return (1);		/* fatal */
    861       1.1   thorpej 
    862       1.1   thorpej 	/*
    863       1.1   thorpej 	 * Now that we've routed all of the PIRQs, rewrite the PCI
    864       1.1   thorpej 	 * configuration headers to reflect the new mapping.
    865       1.1   thorpej 	 */
    866       1.1   thorpej 	if (pciintr_header_fixup(pc) != 0)
    867       1.1   thorpej 		return (1);		/* fatal */
    868       1.1   thorpej 
    869       1.1   thorpej 	/*
    870       1.1   thorpej 	 * Free any unused PCI IRQs for ISA devices.
    871       1.1   thorpej 	 */
    872       1.1   thorpej 	if (pciintr_irq_release(pciirq) != 0)
    873       1.1   thorpej 		return (-1);		/* non-fatal */
    874       1.1   thorpej 
    875       1.1   thorpej 	/*
    876       1.1   thorpej 	 * All done!
    877       1.1   thorpej 	 */
    878       1.1   thorpej 	return (0);			/* success! */
    879       1.1   thorpej }
    880