Root/target/linux/ar71xx/files/arch/mips/pci/pci-ar724x.c

1/*
2 * Atheros AR724x PCI host controller driver
3 *
4 * Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>
5 *
6 * Parts of this file are based on Atheros' 2.6.15 BSP
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License version 2 as published
10 * by the Free Software Foundation.
11 */
12
13#include <linux/resource.h>
14#include <linux/types.h>
15#include <linux/delay.h>
16#include <linux/bitops.h>
17#include <linux/pci.h>
18#include <linux/pci_regs.h>
19#include <linux/interrupt.h>
20
21#include <asm/mach-ar71xx/ar71xx.h>
22#include <asm/mach-ar71xx/pci.h>
23
24#undef DEBUG
25#ifdef DEBUG
26#define DBG(fmt, args...) printk(KERN_INFO fmt, ## args)
27#else
28#define DBG(fmt, args...)
29#endif
30
31static void __iomem *ar724x_pci_localcfg_base;
32static void __iomem *ar724x_pci_devcfg_base;
33static void __iomem *ar724x_pci_ctrl_base;
34static int ar724x_pci_fixup_enable;
35
36static DEFINE_SPINLOCK(ar724x_pci_lock);
37
38static void ar724x_pci_read(void __iomem *base, int where, int size, u32 *value)
39{
40    unsigned long flags;
41    u32 data;
42
43    spin_lock_irqsave(&ar724x_pci_lock, flags);
44    data = __raw_readl(base + (where & ~3));
45
46    switch (size) {
47    case 1:
48        if (where & 1)
49            data >>= 8;
50        if (where & 2)
51            data >>= 16;
52        data &= 0xFF;
53        break;
54    case 2:
55        if (where & 2)
56            data >>= 16;
57        data &= 0xFFFF;
58        break;
59    }
60
61    *value = data;
62    spin_unlock_irqrestore(&ar724x_pci_lock, flags);
63}
64
65static void ar724x_pci_write(void __iomem *base, int where, int size, u32 value)
66{
67    unsigned long flags;
68    u32 data;
69    int s;
70
71    spin_lock_irqsave(&ar724x_pci_lock, flags);
72    data = __raw_readl(base + (where & ~3));
73
74    switch (size) {
75    case 1:
76        s = ((where & 3) << 3);
77        data &= ~(0xFF << s);
78        data |= ((value & 0xFF) << s);
79        break;
80    case 2:
81        s = ((where & 2) << 3);
82        data &= ~(0xFFFF << s);
83        data |= ((value & 0xFFFF) << s);
84        break;
85    case 4:
86        data = value;
87        break;
88    }
89
90    __raw_writel(data, base + (where & ~3));
91    /* flush write */
92    (void)__raw_readl(base + (where & ~3));
93    spin_unlock_irqrestore(&ar724x_pci_lock, flags);
94}
95
96static int ar724x_pci_read_config(struct pci_bus *bus, unsigned int devfn,
97                  int where, int size, u32 *value)
98{
99
100    if (bus->number != 0 || devfn != 0)
101        return PCIBIOS_DEVICE_NOT_FOUND;
102
103    ar724x_pci_read(ar724x_pci_devcfg_base, where, size, value);
104
105    DBG("PCI: read config: %02x:%02x.%01x/%02x:%01d, value=%08x\n",
106            bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn),
107            where, size, *value);
108
109    /*
110     * WAR for BAR issue - We are unable to access the PCI device space
111     * if we set the BAR with proper base address
112     */
113    if ((where == 0x10) && (size == 4)) {
114        u32 val;
115        val = (ar71xx_soc == AR71XX_SOC_AR7240) ? 0xffff : 0x1000ffff;
116        ar724x_pci_write(ar724x_pci_devcfg_base, where, size, val);
117    }
118
119    return PCIBIOS_SUCCESSFUL;
120}
121
122static int ar724x_pci_write_config(struct pci_bus *bus, unsigned int devfn,
123                   int where, int size, u32 value)
124{
125    if (bus->number != 0 || devfn != 0)
126        return PCIBIOS_DEVICE_NOT_FOUND;
127
128    DBG("PCI: write config: %02x:%02x.%01x/%02x:%01d, value=%08x\n",
129        bus->number, PCI_SLOT(devfn), PCI_FUNC(devfn),
130        where, size, value);
131
132    ar724x_pci_write(ar724x_pci_devcfg_base, where, size, value);
133
134    return PCIBIOS_SUCCESSFUL;
135}
136
137static void ar724x_pci_fixup(struct pci_dev *dev)
138{
139    u16 cmd;
140
141    if (!ar724x_pci_fixup_enable)
142        return;
143
144    if (dev->bus->number != 0 || dev->devfn != 0)
145        return;
146
147    /* setup COMMAND register */
148    pci_read_config_word(dev, PCI_COMMAND, &cmd);
149    cmd |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |
150           PCI_COMMAND_INVALIDATE | PCI_COMMAND_PARITY | PCI_COMMAND_SERR |
151           PCI_COMMAND_FAST_BACK;
152
153    pci_write_config_word(dev, PCI_COMMAND, cmd);
154}
155DECLARE_PCI_FIXUP_EARLY(PCI_ANY_ID, PCI_ANY_ID, ar724x_pci_fixup);
156
157int __init ar724x_pcibios_map_irq(const struct pci_dev *dev, uint8_t slot,
158                  uint8_t pin)
159{
160    int irq = -1;
161    int i;
162
163    for (i = 0; i < ar71xx_pci_nr_irqs; i++) {
164        struct ar71xx_pci_irq *entry;
165        entry = &ar71xx_pci_irq_map[i];
166
167        if (entry->slot == slot && entry->pin == pin) {
168            irq = entry->irq;
169            break;
170        }
171    }
172
173    if (irq < 0)
174        printk(KERN_ALERT "PCI: no irq found for pin%u@%s\n",
175                pin, pci_name((struct pci_dev *)dev));
176    else
177        printk(KERN_INFO "PCI: mapping irq %d to pin%u@%s\n",
178                irq, pin, pci_name((struct pci_dev *)dev));
179
180    return irq;
181}
182
183static struct pci_ops ar724x_pci_ops = {
184    .read = ar724x_pci_read_config,
185    .write = ar724x_pci_write_config,
186};
187
188static struct resource ar724x_pci_io_resource = {
189    .name = "PCI IO space",
190    .start = 0,
191    .end = 0,
192    .flags = IORESOURCE_IO,
193};
194
195static struct resource ar724x_pci_mem_resource = {
196    .name = "PCI memory space",
197    .start = AR71XX_PCI_MEM_BASE,
198    .end = AR71XX_PCI_MEM_BASE + AR71XX_PCI_MEM_SIZE - 1,
199    .flags = IORESOURCE_MEM
200};
201
202static struct pci_controller ar724x_pci_controller = {
203    .pci_ops = &ar724x_pci_ops,
204    .mem_resource = &ar724x_pci_mem_resource,
205    .io_resource = &ar724x_pci_io_resource,
206};
207
208static void __init ar724x_pci_reset(void)
209{
210    ar71xx_device_stop(AR724X_RESET_PCIE);
211    ar71xx_device_stop(AR724X_RESET_PCIE_PHY);
212    ar71xx_device_stop(AR724X_RESET_PCIE_PHY_SERIAL);
213    udelay(100);
214
215    ar71xx_device_start(AR724X_RESET_PCIE_PHY_SERIAL);
216    udelay(100);
217    ar71xx_device_start(AR724X_RESET_PCIE_PHY);
218    ar71xx_device_start(AR724X_RESET_PCIE);
219}
220
221static int __init ar724x_pci_setup(void)
222{
223    void __iomem *base = ar724x_pci_ctrl_base;
224    u32 t;
225
226    /* setup COMMAND register */
227    t = PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER | PCI_COMMAND_INVALIDATE |
228        PCI_COMMAND_PARITY|PCI_COMMAND_SERR|PCI_COMMAND_FAST_BACK;
229
230    ar724x_pci_write(ar724x_pci_localcfg_base, PCI_COMMAND, 4, t);
231    ar724x_pci_write(ar724x_pci_localcfg_base, 0x20, 4, 0x1ff01000);
232    ar724x_pci_write(ar724x_pci_localcfg_base, 0x24, 4, 0x1ff01000);
233
234    t = __raw_readl(base + AR724X_PCI_REG_RESET);
235    if (t != 0x7) {
236        udelay(100000);
237        __raw_writel(0, base + AR724X_PCI_REG_RESET);
238        udelay(100);
239        __raw_writel(4, base + AR724X_PCI_REG_RESET);
240        udelay(100000);
241    }
242
243    if (ar71xx_soc == AR71XX_SOC_AR7240)
244        t = AR724X_PCI_APP_LTSSM_ENABLE;
245    else
246        t = 0x1ffc1;
247    __raw_writel(t, base + AR724X_PCI_REG_APP);
248    /* flush write */
249    (void) __raw_readl(base + AR724X_PCI_REG_APP);
250    udelay(1000);
251
252    t = __raw_readl(base + AR724X_PCI_REG_RESET);
253    if ((t & AR724X_PCI_RESET_LINK_UP) == 0x0) {
254        printk(KERN_WARNING "PCI: no PCIe module found\n");
255        return -ENODEV;
256    }
257
258    if (ar71xx_soc == AR71XX_SOC_AR7241 ||
259        ar71xx_soc == AR71XX_SOC_AR7242) {
260        t = __raw_readl(base + AR724X_PCI_REG_APP);
261        t |= BIT(16);
262        __raw_writel(t, base + AR724X_PCI_REG_APP);
263    }
264
265    return 0;
266}
267
268static void ar724x_pci_irq_handler(unsigned int irq, struct irq_desc *desc)
269{
270    void __iomem *base = ar724x_pci_ctrl_base;
271    u32 pending;
272
273    pending = __raw_readl(base + AR724X_PCI_REG_INT_STATUS) &
274          __raw_readl(base + AR724X_PCI_REG_INT_MASK);
275
276    if (pending & AR724X_PCI_INT_DEV0)
277        generic_handle_irq(AR71XX_PCI_IRQ_DEV0);
278
279    else
280        spurious_interrupt();
281}
282
283static void ar724x_pci_irq_unmask(struct irq_data *d)
284{
285    void __iomem *base = ar724x_pci_ctrl_base;
286    u32 t;
287
288    switch (d->irq) {
289    case AR71XX_PCI_IRQ_DEV0:
290        t = __raw_readl(base + AR724X_PCI_REG_INT_MASK);
291        __raw_writel(t | AR724X_PCI_INT_DEV0,
292                 base + AR724X_PCI_REG_INT_MASK);
293        /* flush write */
294        (void) __raw_readl(base + AR724X_PCI_REG_INT_MASK);
295    }
296}
297
298static void ar724x_pci_irq_mask(struct irq_data *d)
299{
300    void __iomem *base = ar724x_pci_ctrl_base;
301    u32 t;
302
303    switch (d->irq) {
304    case AR71XX_PCI_IRQ_DEV0:
305        t = __raw_readl(base + AR724X_PCI_REG_INT_MASK);
306        __raw_writel(t & ~AR724X_PCI_INT_DEV0,
307                 base + AR724X_PCI_REG_INT_MASK);
308
309        /* flush write */
310        (void) __raw_readl(base + AR724X_PCI_REG_INT_MASK);
311
312        t = __raw_readl(base + AR724X_PCI_REG_INT_STATUS);
313        __raw_writel(t | AR724X_PCI_INT_DEV0,
314                 base + AR724X_PCI_REG_INT_STATUS);
315
316        /* flush write */
317        (void) __raw_readl(base + AR724X_PCI_REG_INT_STATUS);
318    }
319}
320
321static struct irq_chip ar724x_pci_irq_chip = {
322    .name = "AR724X PCI ",
323    .irq_mask = ar724x_pci_irq_mask,
324    .irq_unmask = ar724x_pci_irq_unmask,
325    .irq_mask_ack = ar724x_pci_irq_mask,
326};
327
328static void __init ar724x_pci_irq_init(void)
329{
330    void __iomem *base = ar724x_pci_ctrl_base;
331    u32 t;
332    int i;
333
334    t = ar71xx_reset_rr(AR724X_RESET_REG_RESET_MODULE);
335    if (t & (AR724X_RESET_PCIE | AR724X_RESET_PCIE_PHY |
336         AR724X_RESET_PCIE_PHY_SERIAL)) {
337        return;
338    }
339
340    __raw_writel(0, base + AR724X_PCI_REG_INT_MASK);
341    __raw_writel(0, base + AR724X_PCI_REG_INT_STATUS);
342
343    for (i = AR71XX_PCI_IRQ_BASE;
344         i < AR71XX_PCI_IRQ_BASE + AR71XX_PCI_IRQ_COUNT; i++)
345        irq_set_chip_and_handler(i, &ar724x_pci_irq_chip,
346                     handle_level_irq);
347
348    irq_set_chained_handler(AR71XX_CPU_IRQ_IP2, ar724x_pci_irq_handler);
349}
350
351int __init ar724x_pcibios_init(void)
352{
353    int ret = -ENOMEM;
354
355    ar724x_pci_localcfg_base = ioremap_nocache(AR724X_PCI_CRP_BASE,
356                           AR724X_PCI_CRP_SIZE);
357    if (ar724x_pci_localcfg_base == NULL)
358        goto err;
359
360    ar724x_pci_devcfg_base = ioremap_nocache(AR724X_PCI_CFG_BASE,
361                         AR724X_PCI_CFG_SIZE);
362    if (ar724x_pci_devcfg_base == NULL)
363        goto err_unmap_localcfg;
364
365    ar724x_pci_ctrl_base = ioremap_nocache(AR724X_PCI_CTRL_BASE,
366                           AR724X_PCI_CTRL_SIZE);
367    if (ar724x_pci_ctrl_base == NULL)
368        goto err_unmap_devcfg;
369
370    ar724x_pci_reset();
371    ret = ar724x_pci_setup();
372    if (ret)
373        goto err_unmap_ctrl;
374
375    ar724x_pci_fixup_enable = 1;
376    ar724x_pci_irq_init();
377    register_pci_controller(&ar724x_pci_controller);
378
379    return 0;
380
381err_unmap_ctrl:
382    iounmap(ar724x_pci_ctrl_base);
383err_unmap_devcfg:
384    iounmap(ar724x_pci_devcfg_base);
385err_unmap_localcfg:
386    iounmap(ar724x_pci_localcfg_base);
387err:
388    return ret;
389}
390

Archive Download this file



interactive