1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/init.h>
14#include <linux/pci.h>
15#include <linux/kernel.h>
16#include <linux/interrupt.h>
17#include <asm/txx9/generic.h>
18#include <asm/txx9/tx4939.h>
19
20int __init tx4939_report_pciclk(void)
21{
22 int pciclk = 0;
23
24 pr_info("PCIC --%s PCICLK:",
25 (__raw_readq(&tx4939_ccfgptr->ccfg) & TX4939_CCFG_PCI66) ?
26 " PCI66" : "");
27 if (__raw_readq(&tx4939_ccfgptr->pcfg) & TX4939_PCFG_PCICLKEN_ALL) {
28 pciclk = txx9_master_clock * 20 / 6;
29 if (!(__raw_readq(&tx4939_ccfgptr->ccfg) & TX4939_CCFG_PCI66))
30 pciclk /= 2;
31 pr_cont("Internal(%u.%uMHz)",
32 (pciclk + 50000) / 1000000,
33 ((pciclk + 50000) / 100000) % 10);
34 } else {
35 pr_cont("External");
36 pciclk = -1;
37 }
38 pr_cont("\n");
39 return pciclk;
40}
41
42void __init tx4939_report_pci1clk(void)
43{
44 unsigned int pciclk = txx9_master_clock * 20 / 6;
45
46 pr_info("PCIC1 -- PCICLK:%u.%uMHz\n",
47 (pciclk + 50000) / 1000000,
48 ((pciclk + 50000) / 100000) % 10);
49}
50
51int tx4939_pcic1_map_irq(const struct pci_dev *dev, u8 slot)
52{
53 if (get_tx4927_pcicptr(dev->bus->sysdata) == tx4939_pcic1ptr) {
54 switch (slot) {
55 case TX4927_PCIC_IDSEL_AD_TO_SLOT(31):
56 if (__raw_readq(&tx4939_ccfgptr->pcfg) &
57 TX4939_PCFG_ET0MODE)
58 return TXX9_IRQ_BASE + TX4939_IR_ETH(0);
59 break;
60 case TX4927_PCIC_IDSEL_AD_TO_SLOT(30):
61 if (__raw_readq(&tx4939_ccfgptr->pcfg) &
62 TX4939_PCFG_ET1MODE)
63 return TXX9_IRQ_BASE + TX4939_IR_ETH(1);
64 break;
65 }
66 return 0;
67 }
68 return -1;
69}
70
71int tx4939_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
72{
73 int irq = tx4939_pcic1_map_irq(dev, slot);
74
75 if (irq >= 0)
76 return irq;
77 irq = pin;
78
79 irq--;
80 irq = (irq + 33 - slot) % 4;
81 irq++;
82
83 switch (irq) {
84 case 1:
85 irq = TXX9_IRQ_BASE + TX4939_IR_INTA;
86 break;
87 case 2:
88 irq = TXX9_IRQ_BASE + TX4939_IR_INTB;
89 break;
90 case 3:
91 irq = TXX9_IRQ_BASE + TX4939_IR_INTC;
92 break;
93 case 4:
94 irq = TXX9_IRQ_BASE + TX4939_IR_INTD;
95 break;
96 }
97 return irq;
98}
99
100void __init tx4939_setup_pcierr_irq(void)
101{
102 if (request_irq(TXX9_IRQ_BASE + TX4939_IR_PCIERR,
103 tx4927_pcierr_interrupt,
104 0, "PCI error",
105 (void *)TX4939_PCIC_REG))
106 pr_warn("Failed to request irq for PCIERR\n");
107}
108