Blame view

kernel/linux-imx6_3.14.28/drivers/pci/setup-irq.c 1.75 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
  /*
   *	drivers/pci/setup-irq.c
   *
   * Extruded from code written by
   *      Dave Rusling (david.rusling@reo.mts.dec.com)
   *      David Mosberger (davidm@cs.arizona.edu)
   *	David Miller (davem@redhat.com)
   *
   * Support routines for initializing a PCI subsystem.
   */
  
  
  #include <linux/init.h>
  #include <linux/kernel.h>
  #include <linux/pci.h>
  #include <linux/errno.h>
  #include <linux/ioport.h>
  #include <linux/cache.h>
  
  void __weak pcibios_update_irq(struct pci_dev *dev, int irq)
  {
  	dev_dbg(&dev->dev, "assigning IRQ %02d
  ", irq);
  	pci_write_config_byte(dev, PCI_INTERRUPT_LINE, irq);
  }
  
  static void
  pdev_fixup_irq(struct pci_dev *dev,
  	       u8 (*swizzle)(struct pci_dev *, u8 *),
  	       int (*map_irq)(const struct pci_dev *, u8, u8))
  {
  	u8 pin, slot;
  	int irq = 0;
  
  	/* If this device is not on the primary bus, we need to figure out
  	   which interrupt pin it will come in on.   We know which slot it
  	   will come in on 'cos that slot is where the bridge is.   Each
  	   time the interrupt line passes through a PCI-PCI bridge we must
  	   apply the swizzle function.  */
  
  	pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
  	/* Cope with illegal. */
  	if (pin > 4)
  		pin = 1;
  
  	if (pin != 0) {
  		/* Follow the chain of bridges, swizzling as we go.  */
  		slot = (*swizzle)(dev, &pin);
  
  		irq = (*map_irq)(dev, slot, pin);
  		if (irq == -1)
  			irq = 0;
  	}
  	dev->irq = irq;
  
  	dev_dbg(&dev->dev, "fixup irq: got %d
  ", dev->irq);
  
  	/* Always tell the device, so the driver knows what is
  	   the real IRQ to use; the device does not use it. */
  	pcibios_update_irq(dev, irq);
  }
  
  void
  pci_fixup_irqs(u8 (*swizzle)(struct pci_dev *, u8 *),
  	       int (*map_irq)(const struct pci_dev *, u8, u8))
  {
  	struct pci_dev *dev = NULL;
  	for_each_pci_dev(dev)
  		pdev_fixup_irq(dev, swizzle, map_irq);
  }