The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/i386/pci/pci_pir.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * Copyright (c) 1997, Stefan Esser <se@freebsd.org>
    3  * Copyright (c) 2000, Michael Smith <msmith@freebsd.org>
    4  * Copyright (c) 2000, BSDi
    5  * Copyright (c) 2004, John Baldwin <jhb@FreeBSD.org>
    6  * All rights reserved.
    7  *
    8  * Redistribution and use in source and binary forms, with or without
    9  * modification, are permitted provided that the following conditions
   10  * are met:
   11  * 1. Redistributions of source code must retain the above copyright
   12  *    notice unmodified, this list of conditions, and the following
   13  *    disclaimer.
   14  * 2. Redistributions in binary form must reproduce the above copyright
   15  *    notice, this list of conditions and the following disclaimer in the
   16  *    documentation and/or other materials provided with the distribution.
   17  *
   18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
   22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
   23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
   24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
   25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
   26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
   27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   28  */
   29 
   30 #include <sys/cdefs.h>
   31 __FBSDID("$FreeBSD: releng/8.1/sys/i386/pci/pci_pir.c 199583 2009-11-20 15:27:52Z jhb $");
   32 
   33 #include <sys/param.h>
   34 #include <sys/systm.h>
   35 #include <sys/bus.h>
   36 #include <sys/kernel.h>
   37 #include <sys/malloc.h>
   38 #include <sys/module.h>
   39 #include <sys/sysctl.h>
   40 #include <vm/vm.h>
   41 #include <vm/pmap.h>
   42 #include <vm/vm_param.h>
   43 #include <machine/md_var.h>
   44 #include <dev/pci/pcivar.h>
   45 #include <dev/pci/pcireg.h>
   46 #include <machine/pci_cfgreg.h>
   47 #include <machine/segments.h>
   48 #include <machine/pc/bios.h>
   49 
   50 #define NUM_ISA_INTERRUPTS      16
   51 
   52 /*
   53  * A link device.  Loosely based on the ACPI PCI link device.  This doesn't
   54  * try to support priorities for different ISA interrupts.
   55  */
   56 struct pci_link {
   57         TAILQ_ENTRY(pci_link) pl_links;
   58         uint8_t         pl_id;
   59         uint8_t         pl_irq;
   60         uint16_t        pl_irqmask;
   61         int             pl_references;
   62         int             pl_routed;
   63 };
   64 
   65 struct pci_link_lookup {
   66         struct pci_link **pci_link_ptr;
   67         int             bus;
   68         int             device;
   69         int             pin;
   70 };
   71 
   72 struct pci_dev_lookup {
   73         uint8_t         link;
   74         int             bus;
   75         int             device;
   76         int             pin;
   77 };
   78 
   79 typedef void pir_entry_handler(struct PIR_entry *entry,
   80     struct PIR_intpin* intpin, void *arg);
   81 
   82 static void     pci_print_irqmask(u_int16_t irqs);
   83 static int      pci_pir_biosroute(int bus, int device, int func, int pin,
   84                     int irq);
   85 static int      pci_pir_choose_irq(struct pci_link *pci_link, int irqmask);
   86 static void     pci_pir_create_links(struct PIR_entry *entry,
   87                     struct PIR_intpin *intpin, void *arg);
   88 static void     pci_pir_dump_links(void);
   89 static struct pci_link *pci_pir_find_link(uint8_t link_id);
   90 static void     pci_pir_find_link_handler(struct PIR_entry *entry,
   91                     struct PIR_intpin *intpin, void *arg);
   92 static void     pci_pir_initial_irqs(struct PIR_entry *entry,
   93                     struct PIR_intpin *intpin, void *arg);
   94 static void     pci_pir_parse(void);
   95 static uint8_t  pci_pir_search_irq(int bus, int device, int pin);
   96 static int      pci_pir_valid_irq(struct pci_link *pci_link, int irq);
   97 static void     pci_pir_walk_table(pir_entry_handler *handler, void *arg);
   98 
   99 static MALLOC_DEFINE(M_PIR, "$PIR", "$PIR structures");
  100 
  101 static struct PIR_table *pci_route_table;
  102 static device_t pir_device;
  103 static int pci_route_count, pir_bios_irqs, pir_parsed;
  104 static TAILQ_HEAD(, pci_link) pci_links;
  105 static int pir_interrupt_weight[NUM_ISA_INTERRUPTS];
  106 
  107 /* sysctl vars */
  108 SYSCTL_DECL(_hw_pci);
  109 
  110 /* XXX this likely should live in a header file */
  111 #ifdef PC98
  112 /* IRQs 3, 5, 7, 9, 10, 11, 12, 13 */
  113 #define PCI_IRQ_OVERRIDE_MASK 0x3e68
  114 #else
  115 /* IRQs 3, 4, 5, 6, 7, 9, 10, 11, 12, 14, 15 */
  116 #define PCI_IRQ_OVERRIDE_MASK 0xdef8
  117 #endif
  118 
  119 static uint32_t pci_irq_override_mask = PCI_IRQ_OVERRIDE_MASK;
  120 TUNABLE_INT("hw.pci.irq_override_mask", &pci_irq_override_mask);
  121 SYSCTL_INT(_hw_pci, OID_AUTO, irq_override_mask, CTLFLAG_RDTUN,
  122     &pci_irq_override_mask, PCI_IRQ_OVERRIDE_MASK,
  123     "Mask of allowed irqs to try to route when it has no good clue about\n"
  124     "which irqs it should use.");
  125 
  126 /*
  127  * Look for the interrupt routing table.
  128  *
  129  * We use PCI BIOS's PIR table if it's available. $PIR is the standard way
  130  * to do this.  Sadly, some machines are not standards conforming and have
  131  * _PIR instead.  We shrug and cope by looking for both.
  132  */
  133 void
  134 pci_pir_open(void)
  135 {
  136         struct PIR_table *pt;
  137         uint32_t sigaddr;
  138         int i;
  139         uint8_t ck, *cv;
  140 
  141 #ifdef XEN
  142         return;
  143 #else   
  144         /* Don't try if we've already found a table. */
  145         if (pci_route_table != NULL)
  146                 return;
  147 
  148         /* Look for $PIR and then _PIR. */
  149         sigaddr = bios_sigsearch(0, "$PIR", 4, 16, 0);
  150         if (sigaddr == 0)
  151                 sigaddr = bios_sigsearch(0, "_PIR", 4, 16, 0);
  152         if (sigaddr == 0)
  153                 return;
  154 #endif
  155         /* If we found something, check the checksum and length. */
  156         /* XXX - Use pmap_mapdev()? */
  157         pt = (struct PIR_table *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
  158         if (pt->pt_header.ph_length <= sizeof(struct PIR_header))
  159                 return;
  160         for (cv = (u_int8_t *)pt, ck = 0, i = 0;
  161              i < (pt->pt_header.ph_length); i++)
  162                 ck += cv[i];
  163         if (ck != 0)
  164                 return;
  165 
  166         /* Ok, we've got a valid table. */
  167         pci_route_table = pt;
  168         pci_route_count = (pt->pt_header.ph_length -
  169             sizeof(struct PIR_header)) / 
  170             sizeof(struct PIR_entry);
  171 }
  172 
  173 /*
  174  * Find the pci_link structure for a given link ID.
  175  */
  176 static struct pci_link *
  177 pci_pir_find_link(uint8_t link_id)
  178 {
  179         struct pci_link *pci_link;
  180 
  181         TAILQ_FOREACH(pci_link, &pci_links, pl_links) {
  182                 if (pci_link->pl_id == link_id)
  183                         return (pci_link);
  184         }
  185         return (NULL);
  186 }
  187 
  188 /*
  189  * Find the link device associated with a PCI device in the table.
  190  */
  191 static void
  192 pci_pir_find_link_handler(struct PIR_entry *entry, struct PIR_intpin *intpin,
  193     void *arg)
  194 {
  195         struct pci_link_lookup *lookup;
  196 
  197         lookup = (struct pci_link_lookup *)arg;
  198         if (entry->pe_bus == lookup->bus &&
  199             entry->pe_device == lookup->device &&
  200             intpin - entry->pe_intpin == lookup->pin)
  201                 *lookup->pci_link_ptr = pci_pir_find_link(intpin->link);
  202 }
  203 
  204 /*
  205  * Check to see if a possible IRQ setting is valid.
  206  */
  207 static int
  208 pci_pir_valid_irq(struct pci_link *pci_link, int irq)
  209 {
  210 
  211         if (!PCI_INTERRUPT_VALID(irq))
  212                 return (0);
  213         return (pci_link->pl_irqmask & (1 << irq));
  214 }
  215 
  216 /*
  217  * Walk the $PIR executing the worker function for each valid intpin entry
  218  * in the table.  The handler is passed a pointer to both the entry and
  219  * the intpin in the entry.
  220  */
  221 static void
  222 pci_pir_walk_table(pir_entry_handler *handler, void *arg)
  223 {
  224         struct PIR_entry *entry;
  225         struct PIR_intpin *intpin;
  226         int i, pin;
  227 
  228         entry = &pci_route_table->pt_entry[0];
  229         for (i = 0; i < pci_route_count; i++, entry++) {
  230                 intpin = &entry->pe_intpin[0];
  231                 for (pin = 0; pin < 4; pin++, intpin++)
  232                         if (intpin->link != 0)
  233                                 handler(entry, intpin, arg);
  234         }
  235 }
  236 
  237 static void
  238 pci_pir_create_links(struct PIR_entry *entry, struct PIR_intpin *intpin,
  239     void *arg)
  240 {
  241         struct pci_link *pci_link;
  242 
  243         pci_link = pci_pir_find_link(intpin->link);
  244         if (pci_link != NULL) {
  245                 pci_link->pl_references++;
  246                 if (intpin->irqs != pci_link->pl_irqmask) {
  247                         if (bootverbose)
  248                                 printf(
  249         "$PIR: Entry %d.%d.INT%c has different mask for link %#x, merging\n",
  250                                     entry->pe_bus, entry->pe_device,
  251                                     (intpin - entry->pe_intpin) + 'A',
  252                                     pci_link->pl_id);
  253                         pci_link->pl_irqmask &= intpin->irqs;
  254                 }
  255         } else {
  256                 pci_link = malloc(sizeof(struct pci_link), M_PIR, M_WAITOK);
  257                 pci_link->pl_id = intpin->link;
  258                 pci_link->pl_irqmask = intpin->irqs;
  259                 pci_link->pl_irq = PCI_INVALID_IRQ;
  260                 pci_link->pl_references = 1;
  261                 pci_link->pl_routed = 0;
  262                 TAILQ_INSERT_TAIL(&pci_links, pci_link, pl_links);
  263         }
  264 }
  265 
  266 /*
  267  * Look to see if any of the function on the PCI device at bus/device have
  268  * an interrupt routed to intpin 'pin' by the BIOS.
  269  */
  270 static uint8_t
  271 pci_pir_search_irq(int bus, int device, int pin)
  272 {
  273         uint32_t value;
  274         uint8_t func, maxfunc;
  275 
  276         /* See if we have a valid device at function 0. */
  277         value = pci_cfgregread(bus, device, 0, PCIR_HDRTYPE, 1);
  278         if ((value & PCIM_HDRTYPE) > PCI_MAXHDRTYPE)
  279                 return (PCI_INVALID_IRQ);
  280         if (value & PCIM_MFDEV)
  281                 maxfunc = PCI_FUNCMAX;
  282         else
  283                 maxfunc = 0;
  284 
  285         /* Scan all possible functions at this device. */
  286         for (func = 0; func <= maxfunc; func++) {
  287                 value = pci_cfgregread(bus, device, func, PCIR_DEVVENDOR, 4);
  288                 if (value == 0xffffffff)
  289                         continue;
  290                 value = pci_cfgregread(bus, device, func, PCIR_INTPIN, 1);
  291 
  292                 /*
  293                  * See if it uses the pin in question.  Note that the passed
  294                  * in pin uses 0 for A, .. 3 for D whereas the intpin
  295                  * register uses 0 for no interrupt, 1 for A, .. 4 for D.
  296                  */
  297                 if (value != pin + 1)
  298                         continue;
  299                 value = pci_cfgregread(bus, device, func, PCIR_INTLINE, 1);
  300                 if (bootverbose)
  301                         printf(
  302                 "$PIR: Found matching pin for %d.%d.INT%c at func %d: %d\n",
  303                             bus, device, pin + 'A', func, value);
  304                 if (value != PCI_INVALID_IRQ)
  305                         return (value);
  306         }
  307         return (PCI_INVALID_IRQ);
  308 }
  309 
  310 /*
  311  * Try to initialize IRQ based on this device's IRQ.
  312  */
  313 static void
  314 pci_pir_initial_irqs(struct PIR_entry *entry, struct PIR_intpin *intpin,
  315     void *arg)
  316 {
  317         struct pci_link *pci_link;
  318         uint8_t irq, pin;
  319 
  320         pin = intpin - entry->pe_intpin;
  321         pci_link = pci_pir_find_link(intpin->link);
  322         irq = pci_pir_search_irq(entry->pe_bus, entry->pe_device, pin);
  323         if (irq == PCI_INVALID_IRQ || irq == pci_link->pl_irq)
  324                 return;
  325 
  326         /* Don't trust any BIOS IRQs greater than 15. */
  327         if (irq >= NUM_ISA_INTERRUPTS) {
  328                 printf(
  329         "$PIR: Ignoring invalid BIOS IRQ %d from %d.%d.INT%c for link %#x\n",
  330                     irq, entry->pe_bus, entry->pe_device, pin + 'A',
  331                     pci_link->pl_id);
  332                 return;
  333         }
  334 
  335         /*
  336          * If we don't have an IRQ for this link yet, then we trust the
  337          * BIOS, even if it seems invalid from the $PIR entries.
  338          */
  339         if (pci_link->pl_irq == PCI_INVALID_IRQ) {
  340                 if (!pci_pir_valid_irq(pci_link, irq))
  341                         printf(
  342         "$PIR: Using invalid BIOS IRQ %d from %d.%d.INT%c for link %#x\n",
  343                             irq, entry->pe_bus, entry->pe_device, pin + 'A',
  344                             pci_link->pl_id);
  345                 pci_link->pl_irq = irq;
  346                 pci_link->pl_routed = 1;
  347                 return;
  348         }
  349 
  350         /*
  351          * We have an IRQ and it doesn't match the current IRQ for this
  352          * link.  If the new IRQ is invalid, then warn about it and ignore
  353          * it.  If the old IRQ is invalid and the new IRQ is valid, then
  354          * prefer the new IRQ instead.  If both IRQs are valid, then just
  355          * use the first one.  Note that if we ever get into this situation
  356          * we are having to guess which setting the BIOS actually routed.
  357          * Perhaps we should just give up instead.
  358          */
  359         if (!pci_pir_valid_irq(pci_link, irq)) {
  360                 printf(
  361                 "$PIR: BIOS IRQ %d for %d.%d.INT%c is not valid for link %#x\n",
  362                     irq, entry->pe_bus, entry->pe_device, pin + 'A',
  363                     pci_link->pl_id);
  364         } else if (!pci_pir_valid_irq(pci_link, pci_link->pl_irq)) {
  365                 printf(
  366 "$PIR: Preferring valid BIOS IRQ %d from %d.%d.INT%c for link %#x to IRQ %d\n", 
  367                     irq, entry->pe_bus, entry->pe_device, pin + 'A',
  368                     pci_link->pl_id, pci_link->pl_irq);
  369                 pci_link->pl_irq = irq;
  370                 pci_link->pl_routed = 1;
  371         } else
  372                 printf(
  373         "$PIR: BIOS IRQ %d for %d.%d.INT%c does not match link %#x irq %d\n",
  374                     irq, entry->pe_bus, entry->pe_device, pin + 'A',
  375                     pci_link->pl_id, pci_link->pl_irq);
  376 }
  377 
  378 /*
  379  * Parse $PIR to enumerate link devices and attempt to determine their
  380  * initial state.  This could perhaps be cleaner if we had drivers for the
  381  * various interrupt routers as they could read the initial IRQ for each
  382  * link.
  383  */
  384 static void
  385 pci_pir_parse(void)
  386 {
  387         char tunable_buffer[64];
  388         struct pci_link *pci_link;
  389         int i, irq;
  390 
  391         /* Only parse once. */
  392         if (pir_parsed)
  393                 return;
  394         pir_parsed = 1;
  395 
  396         /* Enumerate link devices. */
  397         TAILQ_INIT(&pci_links);
  398         pci_pir_walk_table(pci_pir_create_links, NULL);
  399         if (bootverbose) {
  400                 printf("$PIR: Links after initial probe:\n");
  401                 pci_pir_dump_links();
  402         }
  403 
  404         /*
  405          * Check to see if the BIOS has already routed any of the links by
  406          * checking each device connected to each link to see if it has a
  407          * valid IRQ.
  408          */
  409         pci_pir_walk_table(pci_pir_initial_irqs, NULL);
  410         if (bootverbose) {
  411                 printf("$PIR: Links after initial IRQ discovery:\n");
  412                 pci_pir_dump_links();
  413         }
  414 
  415         /*
  416          * Allow the user to override the IRQ for a given link device.  We
  417          * allow invalid IRQs to be specified but warn about them.  An IRQ
  418          * of 255 or 0 clears any preset IRQ.
  419          */
  420         i = 0;
  421         TAILQ_FOREACH(pci_link, &pci_links, pl_links) {
  422                 snprintf(tunable_buffer, sizeof(tunable_buffer),
  423                     "hw.pci.link.%#x.irq", pci_link->pl_id);
  424                 if (getenv_int(tunable_buffer, &irq) == 0)
  425                         continue;
  426                 if (irq == 0)
  427                         irq = PCI_INVALID_IRQ;
  428                 if (irq != PCI_INVALID_IRQ &&
  429                     !pci_pir_valid_irq(pci_link, irq) && bootverbose)
  430                         printf(
  431                 "$PIR: Warning, IRQ %d for link %#x is not listed as valid\n",
  432                             irq, pci_link->pl_id);
  433                 pci_link->pl_routed = 0;
  434                 pci_link->pl_irq = irq;
  435                 i = 1;
  436         }
  437         if (bootverbose && i) {
  438                 printf("$PIR: Links after tunable overrides:\n");
  439                 pci_pir_dump_links();
  440         }
  441 
  442         /*
  443          * Build initial interrupt weights as well as bitmap of "known-good"
  444          * IRQs that the BIOS has already used for PCI link devices.
  445          */
  446         TAILQ_FOREACH(pci_link, &pci_links, pl_links) {
  447                 if (!PCI_INTERRUPT_VALID(pci_link->pl_irq))
  448                         continue;
  449                 pir_bios_irqs |= 1 << pci_link->pl_irq;
  450                 pir_interrupt_weight[pci_link->pl_irq] +=
  451                     pci_link->pl_references;
  452         }
  453         if (bootverbose) {
  454                 printf("$PIR: IRQs used by BIOS: ");
  455                 pci_print_irqmask(pir_bios_irqs);
  456                 printf("\n");
  457                 printf("$PIR: Interrupt Weights:\n[ ");
  458                 for (i = 0; i < NUM_ISA_INTERRUPTS; i++)
  459                         printf(" %3d", i);
  460                 printf(" ]\n[ ");
  461                 for (i = 0; i < NUM_ISA_INTERRUPTS; i++)
  462                         printf(" %3d", pir_interrupt_weight[i]);
  463                 printf(" ]\n");
  464         }
  465 }
  466 
  467 /*
  468  * Use the PCI BIOS to route an interrupt for a given device.
  469  *
  470  * Input:
  471  * AX = PCIBIOS_ROUTE_INTERRUPT
  472  * BH = bus
  473  * BL = device [7:3] / function [2:0]
  474  * CH = IRQ
  475  * CL = Interrupt Pin (0x0A = A, ... 0x0D = D)
  476  */
  477 static int
  478 pci_pir_biosroute(int bus, int device, int func, int pin, int irq)
  479 {
  480         struct bios_regs args;
  481 
  482         args.eax = PCIBIOS_ROUTE_INTERRUPT;
  483         args.ebx = (bus << 8) | (device << 3) | func;
  484         args.ecx = (irq << 8) | (0xa + pin);
  485 #ifdef XEN
  486         return (0);
  487 #else   
  488         return (bios32(&args, PCIbios.ventry, GSEL(GCODE_SEL, SEL_KPL)));
  489 #endif
  490 }
  491 
  492 
  493 /*
  494  * Route a PCI interrupt using a link device from the $PIR.
  495  */
  496 int
  497 pci_pir_route_interrupt(int bus, int device, int func, int pin)
  498 {
  499         struct pci_link_lookup lookup;
  500         struct pci_link *pci_link;
  501         int error, irq;
  502 
  503         if (pci_route_table == NULL)
  504                 return (PCI_INVALID_IRQ);
  505 
  506         /* Lookup link device for this PCI device/pin. */
  507         pci_link = NULL;
  508         lookup.bus = bus;
  509         lookup.device = device;
  510         lookup.pin = pin - 1;
  511         lookup.pci_link_ptr = &pci_link;
  512         pci_pir_walk_table(pci_pir_find_link_handler, &lookup);
  513         if (pci_link == NULL) {
  514                 printf("$PIR: No matching entry for %d.%d.INT%c\n", bus,
  515                     device, pin - 1 + 'A');
  516                 return (PCI_INVALID_IRQ);
  517         }
  518 
  519         /*
  520          * Pick a new interrupt if we don't have one already.  We look
  521          * for an interrupt from several different sets.  First, if
  522          * this link only has one valid IRQ, use that.  Second, we
  523          * check the set of PCI only interrupts from the $PIR.  Third,
  524          * we check the set of known-good interrupts that the BIOS has
  525          * already used.  Lastly, we check the "all possible valid
  526          * IRQs" set.
  527          */
  528         if (!PCI_INTERRUPT_VALID(pci_link->pl_irq)) {
  529                 if (pci_link->pl_irqmask != 0 && powerof2(pci_link->pl_irqmask))
  530                         irq = ffs(pci_link->pl_irqmask) - 1;
  531                 else
  532                         irq = pci_pir_choose_irq(pci_link,
  533                             pci_route_table->pt_header.ph_pci_irqs);
  534                 if (!PCI_INTERRUPT_VALID(irq))
  535                         irq = pci_pir_choose_irq(pci_link, pir_bios_irqs);
  536                 if (!PCI_INTERRUPT_VALID(irq))
  537                         irq = pci_pir_choose_irq(pci_link,
  538                             pci_irq_override_mask);
  539                 if (!PCI_INTERRUPT_VALID(irq)) {
  540                         if (bootverbose)
  541                                 printf(
  542                         "$PIR: Failed to route interrupt for %d:%d INT%c\n",
  543                                     bus, device, pin - 1 + 'A');
  544                         return (PCI_INVALID_IRQ);
  545                 }
  546                 pci_link->pl_irq = irq;
  547         }
  548 
  549         /* Ask the BIOS to route this IRQ if we haven't done so already. */
  550         if (!pci_link->pl_routed) {
  551                 error = pci_pir_biosroute(bus, device, func, pin - 1,
  552                     pci_link->pl_irq);
  553 
  554                 /* Ignore errors when routing a unique interrupt. */
  555                 if (error && !powerof2(pci_link->pl_irqmask)) {
  556                         printf("$PIR: ROUTE_INTERRUPT failed.\n");
  557                         return (PCI_INVALID_IRQ);
  558                 }
  559                 pci_link->pl_routed = 1;
  560 
  561                 /* Ensure the interrupt is set to level/low trigger. */
  562                 KASSERT(pir_device != NULL, ("missing pir device"));
  563                 BUS_CONFIG_INTR(pir_device, pci_link->pl_irq,
  564                     INTR_TRIGGER_LEVEL, INTR_POLARITY_LOW);
  565         }
  566         if (bootverbose)
  567                 printf("$PIR: %d:%d INT%c routed to irq %d\n", bus, device,
  568                     pin - 1 + 'A', pci_link->pl_irq);
  569         return (pci_link->pl_irq);
  570 }
  571 
  572 /*
  573  * Try to pick an interrupt for the specified link from the interrupts
  574  * set in the mask.
  575  */
  576 static int
  577 pci_pir_choose_irq(struct pci_link *pci_link, int irqmask)
  578 {
  579         int i, irq, realmask;
  580 
  581         /* XXX: Need to have a #define of known bad IRQs to also mask out? */
  582         realmask = pci_link->pl_irqmask & irqmask;
  583         if (realmask == 0)
  584                 return (PCI_INVALID_IRQ);
  585 
  586         /* Find IRQ with lowest weight. */
  587         irq = PCI_INVALID_IRQ;
  588         for (i = 0; i < NUM_ISA_INTERRUPTS; i++) {
  589                 if (!(realmask & 1 << i))
  590                         continue;
  591                 if (irq == PCI_INVALID_IRQ ||
  592                     pir_interrupt_weight[i] < pir_interrupt_weight[irq])
  593                         irq = i;
  594         }
  595         if (bootverbose && PCI_INTERRUPT_VALID(irq)) {
  596                 printf("$PIR: Found IRQ %d for link %#x from ", irq,
  597                     pci_link->pl_id);
  598                 pci_print_irqmask(realmask);
  599                 printf("\n");
  600         }
  601         return (irq);
  602 }
  603 
  604 static void
  605 pci_print_irqmask(u_int16_t irqs)
  606 {
  607         int i, first;
  608 
  609         if (irqs == 0) {
  610                 printf("none");
  611                 return;
  612         }
  613         first = 1;
  614         for (i = 0; i < 16; i++, irqs >>= 1)
  615                 if (irqs & 1) {
  616                         if (!first)
  617                                 printf(" ");
  618                         else
  619                                 first = 0;
  620                         printf("%d", i);
  621                 }
  622 }
  623 
  624 /*
  625  * Display link devices.
  626  */
  627 static void
  628 pci_pir_dump_links(void)
  629 {
  630         struct pci_link *pci_link;
  631 
  632         printf("Link  IRQ  Rtd  Ref  IRQs\n");
  633         TAILQ_FOREACH(pci_link, &pci_links, pl_links) {
  634                 printf("%#4x  %3d   %c   %3d  ", pci_link->pl_id,
  635                     pci_link->pl_irq, pci_link->pl_routed ? 'Y' : 'N',
  636                     pci_link->pl_references);
  637                 pci_print_irqmask(pci_link->pl_irqmask);
  638                 printf("\n");
  639         }
  640 }
  641 
  642 /*
  643  * See if any interrupts for a given PCI bus are routed in the PIR.  Don't
  644  * even bother looking if the BIOS doesn't support routing anyways.  If we
  645  * are probing a PCI-PCI bridge, then require_parse will be true and we should
  646  * only succeed if a host-PCI bridge has already attached and parsed the PIR.
  647  */
  648 int
  649 pci_pir_probe(int bus, int require_parse)
  650 {
  651         int i;
  652 
  653         if (pci_route_table == NULL || (require_parse && !pir_parsed))
  654                 return (0);
  655         for (i = 0; i < pci_route_count; i++)
  656                 if (pci_route_table->pt_entry[i].pe_bus == bus)
  657                         return (1);
  658         return (0);
  659 }
  660 
  661 /*
  662  * The driver for the new-bus psuedo device pir0 for the $PIR table.
  663  */
  664 
  665 static int
  666 pir_probe(device_t dev)
  667 {
  668         char buf[64];
  669 
  670         snprintf(buf, sizeof(buf), "PCI Interrupt Routing Table: %d Entries",
  671             pci_route_count);
  672         device_set_desc_copy(dev, buf);
  673         return (0);
  674 }
  675 
  676 static int
  677 pir_attach(device_t dev)
  678 {
  679 
  680         pci_pir_parse();
  681         KASSERT(pir_device == NULL, ("Multiple pir devices"));
  682         pir_device = dev;
  683         return (0);
  684 }
  685 
  686 static void
  687 pir_resume_find_device(struct PIR_entry *entry, struct PIR_intpin *intpin,
  688     void *arg)
  689 {
  690         struct pci_dev_lookup *pd;
  691 
  692         pd = (struct pci_dev_lookup *)arg;
  693         if (intpin->link != pd->link || pd->bus != -1)
  694                 return;
  695         pd->bus = entry->pe_bus;
  696         pd->device = entry->pe_device;
  697         pd->pin = intpin - entry->pe_intpin;
  698 }
  699 
  700 static int
  701 pir_resume(device_t dev)
  702 {
  703         struct pci_dev_lookup pd;
  704         struct pci_link *pci_link;
  705         int error;
  706 
  707         /* Ask the BIOS to re-route each link that was already routed. */
  708         TAILQ_FOREACH(pci_link, &pci_links, pl_links) {
  709                 if (!PCI_INTERRUPT_VALID(pci_link->pl_irq)) {
  710                         KASSERT(!pci_link->pl_routed,
  711                             ("link %#x is routed but has invalid PCI IRQ",
  712                             pci_link->pl_id));
  713                         continue;
  714                 }
  715                 if (pci_link->pl_routed) {
  716                         pd.bus = -1;
  717                         pd.link = pci_link->pl_id;
  718                         pci_pir_walk_table(pir_resume_find_device, &pd);
  719                         KASSERT(pd.bus != -1,
  720                 ("did not find matching entry for link %#x in the $PIR table",
  721                             pci_link->pl_id));
  722                         if (bootverbose)
  723                                 device_printf(dev,
  724                             "Using %d.%d.INT%c to route link %#x to IRQ %d\n",
  725                                     pd.bus, pd.device, pd.pin + 'A',
  726                                     pci_link->pl_id, pci_link->pl_irq);
  727                         error = pci_pir_biosroute(pd.bus, pd.device, 0, pd.pin,
  728                             pci_link->pl_irq);
  729                         if (error)
  730                                 device_printf(dev,
  731                             "ROUTE_INTERRUPT on resume for link %#x failed.\n",
  732                                     pci_link->pl_id);
  733                 }
  734         }
  735         return (0);
  736 }
  737 
  738 static device_method_t pir_methods[] = {
  739         /* Device interface */
  740         DEVMETHOD(device_probe,         pir_probe),
  741         DEVMETHOD(device_attach,        pir_attach),
  742         DEVMETHOD(device_resume,        pir_resume),
  743 
  744         { 0, 0 }
  745 };
  746 
  747 static driver_t pir_driver = {
  748         "pir",
  749         pir_methods,
  750         1,
  751 };
  752 
  753 static devclass_t pir_devclass;
  754 
  755 DRIVER_MODULE(pir, legacy, pir_driver, pir_devclass, 0, 0);

Cache object: ac6390f9bffdbf525cd0c854384d894d


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.