Merge branch 'for-linus-4.1' of git://git.kernel.org/pub/scm/linux/kernel/git/mason...
[firefly-linux-kernel-4.4.55.git] / arch / unicore32 / kernel / pci.c
1 /*
2  * linux/arch/unicore32/kernel/pci.c
3  *
4  * Code specific to PKUnity SoC and UniCore ISA
5  *
6  * Copyright (C) 2001-2010 GUAN Xue-tao
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  *
12  *  PCI bios-type initialisation for PCI machines
13  *
14  */
15 #include <linux/module.h>
16 #include <linux/kernel.h>
17 #include <linux/interrupt.h>
18 #include <linux/pci.h>
19 #include <linux/slab.h>
20 #include <linux/init.h>
21 #include <linux/io.h>
22
23 static int debug_pci;
24
25 #define CONFIG_CMD(bus, devfn, where)   \
26         (0x80000000 | (bus->number << 16) | (devfn << 8) | (where & ~3))
27
28 static int
29 puv3_read_config(struct pci_bus *bus, unsigned int devfn, int where,
30                         int size, u32 *value)
31 {
32         writel(CONFIG_CMD(bus, devfn, where), PCICFG_ADDR);
33         switch (size) {
34         case 1:
35                 *value = (readl(PCICFG_DATA) >> ((where & 3) * 8)) & 0xFF;
36                 break;
37         case 2:
38                 *value = (readl(PCICFG_DATA) >> ((where & 2) * 8)) & 0xFFFF;
39                 break;
40         case 4:
41                 *value = readl(PCICFG_DATA);
42                 break;
43         }
44         return PCIBIOS_SUCCESSFUL;
45 }
46
47 static int
48 puv3_write_config(struct pci_bus *bus, unsigned int devfn, int where,
49                         int size, u32 value)
50 {
51         writel(CONFIG_CMD(bus, devfn, where), PCICFG_ADDR);
52         switch (size) {
53         case 1:
54                 writel((readl(PCICFG_DATA) & ~FMASK(8, (where&3)*8))
55                         | FIELD(value, 8, (where&3)*8), PCICFG_DATA);
56                 break;
57         case 2:
58                 writel((readl(PCICFG_DATA) & ~FMASK(16, (where&2)*8))
59                         | FIELD(value, 16, (where&2)*8), PCICFG_DATA);
60                 break;
61         case 4:
62                 writel(value, PCICFG_DATA);
63                 break;
64         }
65         return PCIBIOS_SUCCESSFUL;
66 }
67
68 struct pci_ops pci_puv3_ops = {
69         .read  = puv3_read_config,
70         .write = puv3_write_config,
71 };
72
73 void pci_puv3_preinit(void)
74 {
75         printk(KERN_DEBUG "PCI: PKUnity PCI Controller Initializing ...\n");
76         /* config PCI bridge base */
77         writel(io_v2p(PKUNITY_PCIBRI_BASE), PCICFG_BRIBASE);
78
79         writel(0, PCIBRI_AHBCTL0);
80         writel(io_v2p(PKUNITY_PCIBRI_BASE) | PCIBRI_BARx_MEM, PCIBRI_AHBBAR0);
81         writel(0xFFFF0000, PCIBRI_AHBAMR0);
82         writel(0, PCIBRI_AHBTAR0);
83
84         writel(PCIBRI_CTLx_AT, PCIBRI_AHBCTL1);
85         writel(io_v2p(PKUNITY_PCILIO_BASE) | PCIBRI_BARx_IO, PCIBRI_AHBBAR1);
86         writel(0xFFFF0000, PCIBRI_AHBAMR1);
87         writel(0x00000000, PCIBRI_AHBTAR1);
88
89         writel(PCIBRI_CTLx_PREF, PCIBRI_AHBCTL2);
90         writel(io_v2p(PKUNITY_PCIMEM_BASE) | PCIBRI_BARx_MEM, PCIBRI_AHBBAR2);
91         writel(0xF8000000, PCIBRI_AHBAMR2);
92         writel(0, PCIBRI_AHBTAR2);
93
94         writel(io_v2p(PKUNITY_PCIAHB_BASE) | PCIBRI_BARx_MEM, PCIBRI_BAR1);
95
96         writel(PCIBRI_CTLx_AT | PCIBRI_CTLx_PREF, PCIBRI_PCICTL0);
97         writel(io_v2p(PKUNITY_PCIAHB_BASE) | PCIBRI_BARx_MEM, PCIBRI_PCIBAR0);
98         writel(0xF8000000, PCIBRI_PCIAMR0);
99         writel(PKUNITY_SDRAM_BASE, PCIBRI_PCITAR0);
100
101         writel(readl(PCIBRI_CMD) | PCIBRI_CMD_IO | PCIBRI_CMD_MEM, PCIBRI_CMD);
102 }
103
104 static int __init pci_puv3_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
105 {
106         if (dev->bus->number == 0) {
107 #ifdef CONFIG_ARCH_FPGA /* 4 pci slots */
108                 if      (dev->devfn == 0x00)
109                         return IRQ_PCIINTA;
110                 else if (dev->devfn == 0x08)
111                         return IRQ_PCIINTB;
112                 else if (dev->devfn == 0x10)
113                         return IRQ_PCIINTC;
114                 else if (dev->devfn == 0x18)
115                         return IRQ_PCIINTD;
116 #endif
117 #ifdef CONFIG_PUV3_DB0913 /* 3 pci slots */
118                 if      (dev->devfn == 0x30)
119                         return IRQ_PCIINTB;
120                 else if (dev->devfn == 0x60)
121                         return IRQ_PCIINTC;
122                 else if (dev->devfn == 0x58)
123                         return IRQ_PCIINTD;
124 #endif
125 #if     defined(CONFIG_PUV3_NB0916) || defined(CONFIG_PUV3_SMW0919)
126                 /* only support 2 pci devices */
127                 if      (dev->devfn == 0x00)
128                         return IRQ_PCIINTC; /* sata */
129 #endif
130         }
131         return -1;
132 }
133
134 /*
135  * Only first 128MB of memory can be accessed via PCI.
136  * We use GFP_DMA to allocate safe buffers to do map/unmap.
137  * This is really ugly and we need a better way of specifying
138  * DMA-capable regions of memory.
139  */
140 void __init puv3_pci_adjust_zones(unsigned long *zone_size,
141         unsigned long *zhole_size)
142 {
143         unsigned int sz = SZ_128M >> PAGE_SHIFT;
144
145         /*
146          * Only adjust if > 128M on current system
147          */
148         if (zone_size[0] <= sz)
149                 return;
150
151         zone_size[1] = zone_size[0] - sz;
152         zone_size[0] = sz;
153         zhole_size[1] = zhole_size[0];
154         zhole_size[0] = 0;
155 }
156
157 /*
158  * If the bus contains any of these devices, then we must not turn on
159  * parity checking of any kind.
160  */
161 static inline int pdev_bad_for_parity(struct pci_dev *dev)
162 {
163         return 0;
164 }
165
166 /*
167  * pcibios_fixup_bus - Called after each bus is probed,
168  * but before its children are examined.
169  */
170 void pcibios_fixup_bus(struct pci_bus *bus)
171 {
172         struct pci_dev *dev;
173         u16 features = PCI_COMMAND_SERR
174                 | PCI_COMMAND_PARITY
175                 | PCI_COMMAND_FAST_BACK;
176
177         bus->resource[0] = &ioport_resource;
178         bus->resource[1] = &iomem_resource;
179
180         /*
181          * Walk the devices on this bus, working out what we can
182          * and can't support.
183          */
184         list_for_each_entry(dev, &bus->devices, bus_list) {
185                 u16 status;
186
187                 pci_read_config_word(dev, PCI_STATUS, &status);
188
189                 /*
190                  * If any device on this bus does not support fast back
191                  * to back transfers, then the bus as a whole is not able
192                  * to support them.  Having fast back to back transfers
193                  * on saves us one PCI cycle per transaction.
194                  */
195                 if (!(status & PCI_STATUS_FAST_BACK))
196                         features &= ~PCI_COMMAND_FAST_BACK;
197
198                 if (pdev_bad_for_parity(dev))
199                         features &= ~(PCI_COMMAND_SERR
200                                         | PCI_COMMAND_PARITY);
201
202                 switch (dev->class >> 8) {
203                 case PCI_CLASS_BRIDGE_PCI:
204                         pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &status);
205                         status |= PCI_BRIDGE_CTL_PARITY
206                                 | PCI_BRIDGE_CTL_MASTER_ABORT;
207                         status &= ~(PCI_BRIDGE_CTL_BUS_RESET
208                                 | PCI_BRIDGE_CTL_FAST_BACK);
209                         pci_write_config_word(dev, PCI_BRIDGE_CONTROL, status);
210                         break;
211
212                 case PCI_CLASS_BRIDGE_CARDBUS:
213                         pci_read_config_word(dev, PCI_CB_BRIDGE_CONTROL,
214                                         &status);
215                         status |= PCI_CB_BRIDGE_CTL_PARITY
216                                 | PCI_CB_BRIDGE_CTL_MASTER_ABORT;
217                         pci_write_config_word(dev, PCI_CB_BRIDGE_CONTROL,
218                                         status);
219                         break;
220                 }
221         }
222
223         /*
224          * Now walk the devices again, this time setting them up.
225          */
226         list_for_each_entry(dev, &bus->devices, bus_list) {
227                 u16 cmd;
228
229                 pci_read_config_word(dev, PCI_COMMAND, &cmd);
230                 cmd |= features;
231                 pci_write_config_word(dev, PCI_COMMAND, cmd);
232
233                 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE,
234                                       L1_CACHE_BYTES >> 2);
235         }
236
237         /*
238          * Propagate the flags to the PCI bridge.
239          */
240         if (bus->self && bus->self->hdr_type == PCI_HEADER_TYPE_BRIDGE) {
241                 if (features & PCI_COMMAND_FAST_BACK)
242                         bus->bridge_ctl |= PCI_BRIDGE_CTL_FAST_BACK;
243                 if (features & PCI_COMMAND_PARITY)
244                         bus->bridge_ctl |= PCI_BRIDGE_CTL_PARITY;
245         }
246
247         /*
248          * Report what we did for this bus
249          */
250         printk(KERN_INFO "PCI: bus%d: Fast back to back transfers %sabled\n",
251                 bus->number, (features & PCI_COMMAND_FAST_BACK) ? "en" : "dis");
252 }
253 EXPORT_SYMBOL(pcibios_fixup_bus);
254
255 static int __init pci_common_init(void)
256 {
257         struct pci_bus *puv3_bus;
258
259         pci_puv3_preinit();
260
261         puv3_bus = pci_scan_bus(0, &pci_puv3_ops, NULL);
262
263         if (!puv3_bus)
264                 panic("PCI: unable to scan bus!");
265
266         pci_fixup_irqs(pci_common_swizzle, pci_puv3_map_irq);
267
268         if (!pci_has_flag(PCI_PROBE_ONLY)) {
269                 pci_bus_size_bridges(puv3_bus);
270                 pci_bus_assign_resources(puv3_bus);
271         }
272         pci_bus_add_devices(puv3_bus);
273         return 0;
274 }
275 subsys_initcall(pci_common_init);
276
277 char * __init pcibios_setup(char *str)
278 {
279         if (!strcmp(str, "debug")) {
280                 debug_pci = 1;
281                 return NULL;
282         } else if (!strcmp(str, "firmware")) {
283                 pci_add_flags(PCI_PROBE_ONLY);
284                 return NULL;
285         }
286         return str;
287 }
288
289 void pcibios_set_master(struct pci_dev *dev)
290 {
291         /* No special bus mastering setup handling */
292 }
293
294 /*
295  * From arch/i386/kernel/pci-i386.c:
296  *
297  * We need to avoid collisions with `mirrored' VGA ports
298  * and other strange ISA hardware, so we always want the
299  * addresses to be allocated in the 0x000-0x0ff region
300  * modulo 0x400.
301  *
302  * Why? Because some silly external IO cards only decode
303  * the low 10 bits of the IO address. The 0x00-0xff region
304  * is reserved for motherboard devices that decode all 16
305  * bits, so it's ok to allocate at, say, 0x2800-0x28ff,
306  * but we want to try to avoid allocating at 0x2900-0x2bff
307  * which might be mirrored at 0x0100-0x03ff..
308  */
309 resource_size_t pcibios_align_resource(void *data, const struct resource *res,
310                                 resource_size_t size, resource_size_t align)
311 {
312         resource_size_t start = res->start;
313
314         if (res->flags & IORESOURCE_IO && start & 0x300)
315                 start = (start + 0x3ff) & ~0x3ff;
316
317         start = (start + align - 1) & ~(align - 1);
318
319         return start;
320 }
321
322 /**
323  * pcibios_enable_device - Enable I/O and memory.
324  * @dev: PCI device to be enabled
325  */
326 int pcibios_enable_device(struct pci_dev *dev, int mask)
327 {
328         u16 cmd, old_cmd;
329         int idx;
330         struct resource *r;
331
332         pci_read_config_word(dev, PCI_COMMAND, &cmd);
333         old_cmd = cmd;
334         for (idx = 0; idx < 6; idx++) {
335                 /* Only set up the requested stuff */
336                 if (!(mask & (1 << idx)))
337                         continue;
338
339                 r = dev->resource + idx;
340                 if (!r->start && r->end) {
341                         printk(KERN_ERR "PCI: Device %s not available because"
342                                " of resource collisions\n", pci_name(dev));
343                         return -EINVAL;
344                 }
345                 if (r->flags & IORESOURCE_IO)
346                         cmd |= PCI_COMMAND_IO;
347                 if (r->flags & IORESOURCE_MEM)
348                         cmd |= PCI_COMMAND_MEMORY;
349         }
350
351         /*
352          * Bridges (eg, cardbus bridges) need to be fully enabled
353          */
354         if ((dev->class >> 16) == PCI_BASE_CLASS_BRIDGE)
355                 cmd |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
356
357         if (cmd != old_cmd) {
358                 printk("PCI: enabling device %s (%04x -> %04x)\n",
359                        pci_name(dev), old_cmd, cmd);
360                 pci_write_config_word(dev, PCI_COMMAND, cmd);
361         }
362         return 0;
363 }
364
365 int pci_mmap_page_range(struct pci_dev *dev, struct vm_area_struct *vma,
366                         enum pci_mmap_state mmap_state, int write_combine)
367 {
368         unsigned long phys;
369
370         if (mmap_state == pci_mmap_io)
371                 return -EINVAL;
372
373         phys = vma->vm_pgoff;
374
375         /*
376          * Mark this as IO
377          */
378         vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
379
380         if (remap_pfn_range(vma, vma->vm_start, phys,
381                              vma->vm_end - vma->vm_start,
382                              vma->vm_page_prot))
383                 return -EAGAIN;
384
385         return 0;
386 }