1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/pci.h>
13#include <linux/slab.h>
14#include <linux/mbus.h>
15#include <asm/irq.h>
16#include <asm/mach/pci.h>
17#include <plat/pcie.h>
18#include <mach/bridge-regs.h>
19#include "common.h"
20
21void kirkwood_enable_pcie(void)
22{
23 u32 curr = readl(CLOCK_GATING_CTRL);
24 if (!(curr & CGC_PEX0))
25 writel(curr | CGC_PEX0, CLOCK_GATING_CTRL);
26}
27
28void __init kirkwood_pcie_id(u32 *dev, u32 *rev)
29{
30 kirkwood_enable_pcie();
31 *dev = orion_pcie_dev_id((void __iomem *)PCIE_VIRT_BASE);
32 *rev = orion_pcie_rev((void __iomem *)PCIE_VIRT_BASE);
33}
34
35struct pcie_port {
36 u8 root_bus_nr;
37 void __iomem *base;
38 spinlock_t conf_lock;
39 int irq;
40 struct resource res[2];
41};
42
43static int pcie_port_map[2];
44static int num_pcie_ports;
45
46static inline struct pcie_port *bus_to_port(struct pci_bus *bus)
47{
48 struct pci_sys_data *sys = bus->sysdata;
49 return sys->private_data;
50}
51
52static int pcie_valid_config(struct pcie_port *pp, int bus, int dev)
53{
54
55
56
57
58
59 if (bus == pp->root_bus_nr && dev == 0)
60 return 1;
61
62 if (!orion_pcie_link_up(pp->base))
63 return 0;
64
65 if (bus == pp->root_bus_nr && dev != 1)
66 return 0;
67
68 return 1;
69}
70
71
72
73
74
75
76
77
78static int pcie_rd_conf(struct pci_bus *bus, u32 devfn, int where,
79 int size, u32 *val)
80{
81 struct pcie_port *pp = bus_to_port(bus);
82 unsigned long flags;
83 int ret;
84
85 if (pcie_valid_config(pp, bus->number, PCI_SLOT(devfn)) == 0) {
86 *val = 0xffffffff;
87 return PCIBIOS_DEVICE_NOT_FOUND;
88 }
89
90 spin_lock_irqsave(&pp->conf_lock, flags);
91 ret = orion_pcie_rd_conf(pp->base, bus, devfn, where, size, val);
92 spin_unlock_irqrestore(&pp->conf_lock, flags);
93
94 return ret;
95}
96
97static int pcie_wr_conf(struct pci_bus *bus, u32 devfn,
98 int where, int size, u32 val)
99{
100 struct pcie_port *pp = bus_to_port(bus);
101 unsigned long flags;
102 int ret;
103
104 if (pcie_valid_config(pp, bus->number, PCI_SLOT(devfn)) == 0)
105 return PCIBIOS_DEVICE_NOT_FOUND;
106
107 spin_lock_irqsave(&pp->conf_lock, flags);
108 ret = orion_pcie_wr_conf(pp->base, bus, devfn, where, size, val);
109 spin_unlock_irqrestore(&pp->conf_lock, flags);
110
111 return ret;
112}
113
114static struct pci_ops pcie_ops = {
115 .read = pcie_rd_conf,
116 .write = pcie_wr_conf,
117};
118
119static void __init pcie0_ioresources_init(struct pcie_port *pp)
120{
121 pp->base = (void __iomem *)PCIE_VIRT_BASE;
122 pp->irq = IRQ_KIRKWOOD_PCIE;
123
124
125
126
127 pp->res[0].name = "PCIe 0 I/O Space";
128 pp->res[0].start = KIRKWOOD_PCIE_IO_BUS_BASE;
129 pp->res[0].end = pp->res[0].start + KIRKWOOD_PCIE_IO_SIZE - 1;
130 pp->res[0].flags = IORESOURCE_IO;
131
132
133
134
135 pp->res[1].name = "PCIe 0 MEM";
136 pp->res[1].start = KIRKWOOD_PCIE_MEM_PHYS_BASE;
137 pp->res[1].end = pp->res[1].start + KIRKWOOD_PCIE_MEM_SIZE - 1;
138 pp->res[1].flags = IORESOURCE_MEM;
139}
140
141static void __init pcie1_ioresources_init(struct pcie_port *pp)
142{
143 pp->base = (void __iomem *)PCIE1_VIRT_BASE;
144 pp->irq = IRQ_KIRKWOOD_PCIE1;
145
146
147
148
149 pp->res[0].name = "PCIe 1 I/O Space";
150 pp->res[0].start = KIRKWOOD_PCIE1_IO_BUS_BASE;
151 pp->res[0].end = pp->res[0].start + KIRKWOOD_PCIE1_IO_SIZE - 1;
152 pp->res[0].flags = IORESOURCE_IO;
153
154
155
156
157 pp->res[1].name = "PCIe 1 MEM";
158 pp->res[1].start = KIRKWOOD_PCIE1_MEM_PHYS_BASE;
159 pp->res[1].end = pp->res[1].start + KIRKWOOD_PCIE1_MEM_SIZE - 1;
160 pp->res[1].flags = IORESOURCE_MEM;
161}
162
163static int __init kirkwood_pcie_setup(int nr, struct pci_sys_data *sys)
164{
165 extern unsigned int kirkwood_clk_ctrl;
166 struct pcie_port *pp;
167 int index;
168
169 if (nr >= num_pcie_ports)
170 return 0;
171
172 index = pcie_port_map[nr];
173 printk(KERN_INFO "PCI: bus%d uses PCIe port %d\n", sys->busnr, index);
174
175 pp = kzalloc(sizeof(*pp), GFP_KERNEL);
176 if (!pp)
177 panic("PCIe: failed to allocate pcie_port data");
178 sys->private_data = pp;
179 pp->root_bus_nr = sys->busnr;
180 spin_lock_init(&pp->conf_lock);
181
182 switch (index) {
183 case 0:
184 kirkwood_clk_ctrl |= CGC_PEX0;
185 pcie0_ioresources_init(pp);
186 break;
187 case 1:
188 kirkwood_clk_ctrl |= CGC_PEX1;
189 pcie1_ioresources_init(pp);
190 break;
191 default:
192 panic("PCIe setup: invalid controller %d", index);
193 }
194
195 if (request_resource(&ioport_resource, &pp->res[0]))
196 panic("Request PCIe%d IO resource failed\n", index);
197 if (request_resource(&iomem_resource, &pp->res[1]))
198 panic("Request PCIe%d Memory resource failed\n", index);
199
200 sys->resource[0] = &pp->res[0];
201 sys->resource[1] = &pp->res[1];
202 sys->resource[2] = NULL;
203 sys->io_offset = 0;
204
205
206
207
208 orion_pcie_set_local_bus_nr(pp->base, sys->busnr);
209
210 orion_pcie_setup(pp->base, &kirkwood_mbus_dram_info);
211
212 return 1;
213}
214
215static void __devinit rc_pci_fixup(struct pci_dev *dev)
216{
217
218
219
220 if (dev->bus->parent == NULL && dev->devfn == 0) {
221 int i;
222
223 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
224 dev->resource[i].start = 0;
225 dev->resource[i].end = 0;
226 dev->resource[i].flags = 0;
227 }
228 }
229}
230DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_MARVELL, PCI_ANY_ID, rc_pci_fixup);
231
232static struct pci_bus __init *
233kirkwood_pcie_scan_bus(int nr, struct pci_sys_data *sys)
234{
235 struct pci_bus *bus;
236
237 if (nr < num_pcie_ports) {
238 bus = pci_scan_bus(sys->busnr, &pcie_ops, sys);
239 } else {
240 bus = NULL;
241 BUG();
242 }
243
244 return bus;
245}
246
247static int __init kirkwood_pcie_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
248{
249 struct pcie_port *pp = bus_to_port(dev->bus);
250
251 return pp->irq;
252}
253
254static struct hw_pci kirkwood_pci __initdata = {
255 .swizzle = pci_std_swizzle,
256 .setup = kirkwood_pcie_setup,
257 .scan = kirkwood_pcie_scan_bus,
258 .map_irq = kirkwood_pcie_map_irq,
259};
260
261static void __init add_pcie_port(int index, unsigned long base)
262{
263 printk(KERN_INFO "Kirkwood PCIe port %d: ", index);
264
265 if (orion_pcie_link_up((void __iomem *)base)) {
266 printk(KERN_INFO "link up\n");
267 pcie_port_map[num_pcie_ports++] = index;
268 } else
269 printk(KERN_INFO "link down, ignoring\n");
270}
271
272void __init kirkwood_pcie_init(unsigned int portmask)
273{
274 if (portmask & KW_PCIE0)
275 add_pcie_port(0, PCIE_VIRT_BASE);
276
277 if (portmask & KW_PCIE1)
278 add_pcie_port(1, PCIE1_VIRT_BASE);
279
280 kirkwood_pci.nr_controllers = num_pcie_ports;
281 pci_common_init(&kirkwood_pci);
282}
283