2 * Support for Celleb PCI-Express.
4 * (C) Copyright 2007-2008 TOSHIBA CORPORATION
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #include <linux/kernel.h>
24 #include <linux/pci.h>
25 #include <linux/string.h>
26 #include <linux/init.h>
27 #include <linux/bootmem.h>
28 #include <linux/delay.h>
29 #include <linux/interrupt.h>
33 #include <asm/iommu.h>
34 #include <asm/byteorder.h>
36 #include "celleb_scc.h"
37 #include "celleb_pci.h"
39 #define PEX_IN(base, off) in_be32((void __iomem *)(base) + (off))
40 #define PEX_OUT(base, off, data) out_be32((void __iomem *)(base) + (off), (data))
42 static void scc_pciex_io_flush(struct iowa_bus
*bus
)
44 (void)PEX_IN(bus
->phb
->cfg_addr
, PEXDMRDEN0
);
48 * Memory space access to device on PCIEX
50 #define PCIEX_MMIO_READ(name, ret) \
51 static ret scc_pciex_##name(const PCI_IO_ADDR addr) \
53 ret val = __do_##name(addr); \
54 scc_pciex_io_flush(iowa_mem_find_bus(addr)); \
58 #define PCIEX_MMIO_READ_STR(name) \
59 static void scc_pciex_##name(const PCI_IO_ADDR addr, void *buf, \
60 unsigned long count) \
62 __do_##name(addr, buf, count); \
63 scc_pciex_io_flush(iowa_mem_find_bus(addr)); \
66 PCIEX_MMIO_READ(readb
, u8
)
67 PCIEX_MMIO_READ(readw
, u16
)
68 PCIEX_MMIO_READ(readl
, u32
)
69 PCIEX_MMIO_READ(readq
, u64
)
70 PCIEX_MMIO_READ(readw_be
, u16
)
71 PCIEX_MMIO_READ(readl_be
, u32
)
72 PCIEX_MMIO_READ(readq_be
, u64
)
73 PCIEX_MMIO_READ_STR(readsb
)
74 PCIEX_MMIO_READ_STR(readsw
)
75 PCIEX_MMIO_READ_STR(readsl
)
77 static void scc_pciex_memcpy_fromio(void *dest
, const PCI_IO_ADDR src
,
80 __do_memcpy_fromio(dest
, src
, n
);
81 scc_pciex_io_flush(iowa_mem_find_bus(src
));
85 * I/O port access to devices on PCIEX.
88 static inline unsigned long get_bus_address(struct pci_controller
*phb
,
91 return port
- ((unsigned long)(phb
->io_base_virt
) - _IO_BASE
);
94 static u32
scc_pciex_read_port(struct pci_controller
*phb
,
95 unsigned long port
, int size
)
97 unsigned int byte_enable
;
98 unsigned int cmd
, shift
;
102 BUG_ON(((port
& 0x3ul
) + size
) > 4);
104 addr
= get_bus_address(phb
, port
);
105 shift
= addr
& 0x3ul
;
106 byte_enable
= ((1 << size
) - 1) << shift
;
107 cmd
= PEXDCMND_IO_READ
| (byte_enable
<< PEXDCMND_BYTE_EN_SHIFT
);
108 PEX_OUT(phb
->cfg_addr
, PEXDADRS
, (addr
& ~0x3ul
));
109 PEX_OUT(phb
->cfg_addr
, PEXDCMND
, cmd
);
110 data
= PEX_IN(phb
->cfg_addr
, PEXDRDATA
);
111 ret
= (data
>> (shift
* 8)) & (0xFFFFFFFF >> ((4 - size
) * 8));
113 pr_debug("PCIEX:PIO READ:port=0x%lx, addr=0x%lx, size=%d, be=%x,"
114 " cmd=%x, data=%x, ret=%x\n", port
, addr
, size
, byte_enable
,
120 static void scc_pciex_write_port(struct pci_controller
*phb
,
121 unsigned long port
, int size
, u32 val
)
123 unsigned int byte_enable
;
124 unsigned int cmd
, shift
;
128 BUG_ON(((port
& 0x3ul
) + size
) > 4);
130 addr
= get_bus_address(phb
, port
);
131 shift
= addr
& 0x3ul
;
132 byte_enable
= ((1 << size
) - 1) << shift
;
133 cmd
= PEXDCMND_IO_WRITE
| (byte_enable
<< PEXDCMND_BYTE_EN_SHIFT
);
134 data
= (val
& (0xFFFFFFFF >> (4 - size
) * 8)) << (shift
* 8);
135 PEX_OUT(phb
->cfg_addr
, PEXDADRS
, (addr
& ~0x3ul
));
136 PEX_OUT(phb
->cfg_addr
, PEXDCMND
, cmd
);
137 PEX_OUT(phb
->cfg_addr
, PEXDWDATA
, data
);
139 pr_debug("PCIEX:PIO WRITE:port=0x%lx, addr=%lx, size=%d, val=%x,"
140 " be=%x, cmd=%x, data=%x\n", port
, addr
, size
, val
,
141 byte_enable
, cmd
, data
);
144 static u8
__scc_pciex_inb(struct pci_controller
*phb
, unsigned long port
)
146 return (u8
)scc_pciex_read_port(phb
, port
, 1);
149 static u16
__scc_pciex_inw(struct pci_controller
*phb
, unsigned long port
)
152 if ((port
& 0x3ul
) < 3)
153 data
= scc_pciex_read_port(phb
, port
, 2);
155 u32 d1
= scc_pciex_read_port(phb
, port
, 1);
156 u32 d2
= scc_pciex_read_port(phb
, port
+ 1, 1);
157 data
= d1
| (d2
<< 8);
162 static u32
__scc_pciex_inl(struct pci_controller
*phb
, unsigned long port
)
164 unsigned int mod
= port
& 0x3ul
;
167 data
= scc_pciex_read_port(phb
, port
, 4);
169 u32 d1
= scc_pciex_read_port(phb
, port
, 4 - mod
);
170 u32 d2
= scc_pciex_read_port(phb
, port
+ 1, mod
);
171 data
= d1
| (d2
<< (mod
* 8));
176 static void __scc_pciex_outb(struct pci_controller
*phb
,
177 u8 val
, unsigned long port
)
179 scc_pciex_write_port(phb
, port
, 1, (u32
)val
);
182 static void __scc_pciex_outw(struct pci_controller
*phb
,
183 u16 val
, unsigned long port
)
185 if ((port
& 0x3ul
) < 3)
186 scc_pciex_write_port(phb
, port
, 2, (u32
)val
);
188 u32 d1
= val
& 0x000000FF;
189 u32 d2
= (val
& 0x0000FF00) >> 8;
190 scc_pciex_write_port(phb
, port
, 1, d1
);
191 scc_pciex_write_port(phb
, port
+ 1, 1, d2
);
195 static void __scc_pciex_outl(struct pci_controller
*phb
,
196 u32 val
, unsigned long port
)
198 unsigned int mod
= port
& 0x3ul
;
200 scc_pciex_write_port(phb
, port
, 4, val
);
202 u32 d1
= val
& (0xFFFFFFFFul
>> (mod
* 8));
203 u32 d2
= val
>> ((4 - mod
) * 8);
204 scc_pciex_write_port(phb
, port
, 4 - mod
, d1
);
205 scc_pciex_write_port(phb
, port
+ 1, mod
, d2
);
209 #define PCIEX_PIO_FUNC(size, name) \
210 static u##size scc_pciex_in##name(unsigned long port) \
212 struct iowa_bus *bus = iowa_pio_find_bus(port); \
213 u##size data = __scc_pciex_in##name(bus->phb, port); \
214 scc_pciex_io_flush(bus); \
217 static void scc_pciex_ins##name(unsigned long p, void *b, unsigned long c) \
219 struct iowa_bus *bus = iowa_pio_find_bus(p); \
221 for (; c != 0; c--, dst++) \
222 *dst = cpu_to_le##size(__scc_pciex_in##name(bus->phb, p)); \
223 scc_pciex_io_flush(bus); \
225 static void scc_pciex_out##name(u##size val, unsigned long port) \
227 struct iowa_bus *bus = iowa_pio_find_bus(port); \
228 __scc_pciex_out##name(bus->phb, val, port); \
230 static void scc_pciex_outs##name(unsigned long p, const void *b, \
233 struct iowa_bus *bus = iowa_pio_find_bus(p); \
234 const u##size *src = b; \
235 for (; c != 0; c--, src++) \
236 __scc_pciex_out##name(bus->phb, le##size##_to_cpu(*src), p); \
238 #define cpu_to_le8(x) (x)
239 #define le8_to_cpu(x) (x)
241 PCIEX_PIO_FUNC(16, w
)
242 PCIEX_PIO_FUNC(32, l
)
244 static struct ppc_pci_io scc_pciex_ops
= {
245 .readb
= scc_pciex_readb
,
246 .readw
= scc_pciex_readw
,
247 .readl
= scc_pciex_readl
,
248 .readq
= scc_pciex_readq
,
249 .readw_be
= scc_pciex_readw_be
,
250 .readl_be
= scc_pciex_readl_be
,
251 .readq_be
= scc_pciex_readq_be
,
252 .readsb
= scc_pciex_readsb
,
253 .readsw
= scc_pciex_readsw
,
254 .readsl
= scc_pciex_readsl
,
255 .memcpy_fromio
= scc_pciex_memcpy_fromio
,
256 .inb
= scc_pciex_inb
,
257 .inw
= scc_pciex_inw
,
258 .inl
= scc_pciex_inl
,
259 .outb
= scc_pciex_outb
,
260 .outw
= scc_pciex_outw
,
261 .outl
= scc_pciex_outl
,
262 .insb
= scc_pciex_insb
,
263 .insw
= scc_pciex_insw
,
264 .insl
= scc_pciex_insl
,
265 .outsb
= scc_pciex_outsb
,
266 .outsw
= scc_pciex_outsw
,
267 .outsl
= scc_pciex_outsl
,
270 static int __init
scc_pciex_iowa_init(struct iowa_bus
*bus
, void *data
)
272 dma_addr_t dummy_page_da
;
275 dummy_page_va
= kmalloc(PAGE_SIZE
, GFP_KERNEL
);
276 if (!dummy_page_va
) {
277 pr_err("PCIEX:Alloc dummy_page_va failed\n");
281 dummy_page_da
= dma_map_single(bus
->phb
->parent
, dummy_page_va
,
282 PAGE_SIZE
, DMA_FROM_DEVICE
);
283 if (dma_mapping_error(dummy_page_da
)) {
284 pr_err("PCIEX:Map dummy page failed.\n");
285 kfree(dummy_page_va
);
289 PEX_OUT(bus
->phb
->cfg_addr
, PEXDMRDADR0
, dummy_page_da
);
295 * config space access
297 #define MK_PEXDADRS(bus_no, dev_no, func_no, addr) \
298 ((uint32_t)(((addr) & ~0x3UL) | \
299 ((bus_no) << PEXDADRS_BUSNO_SHIFT) | \
300 ((dev_no) << PEXDADRS_DEVNO_SHIFT) | \
301 ((func_no) << PEXDADRS_FUNCNO_SHIFT)))
303 #define MK_PEXDCMND_BYTE_EN(addr, size) \
304 ((((0x1 << (size))-1) << ((addr) & 0x3)) << PEXDCMND_BYTE_EN_SHIFT)
305 #define MK_PEXDCMND(cmd, addr, size) ((cmd) | MK_PEXDCMND_BYTE_EN(addr, size))
307 static uint32_t config_read_pciex_dev(unsigned int __iomem
*base
,
308 uint64_t bus_no
, uint64_t dev_no
, uint64_t func_no
,
309 uint64_t off
, uint64_t size
)
314 addr
= MK_PEXDADRS(bus_no
, dev_no
, func_no
, off
);
315 cmd
= MK_PEXDCMND(PEXDCMND_CONFIG_READ
, off
, size
);
316 PEX_OUT(base
, PEXDADRS
, addr
);
317 PEX_OUT(base
, PEXDCMND
, cmd
);
318 ret
= (PEX_IN(base
, PEXDRDATA
)
319 >> ((off
& (4-size
)) * 8)) & ((0x1 << (size
* 8)) - 1);
323 static void config_write_pciex_dev(unsigned int __iomem
*base
, uint64_t bus_no
,
324 uint64_t dev_no
, uint64_t func_no
, uint64_t off
, uint64_t size
,
329 addr
= MK_PEXDADRS(bus_no
, dev_no
, func_no
, off
);
330 cmd
= MK_PEXDCMND(PEXDCMND_CONFIG_WRITE
, off
, size
);
331 PEX_OUT(base
, PEXDADRS
, addr
);
332 PEX_OUT(base
, PEXDCMND
, cmd
);
333 PEX_OUT(base
, PEXDWDATA
,
334 (data
& ((0x1 << (size
* 8)) - 1)) << ((off
& (4-size
)) * 8));
337 #define MK_PEXCADRS_BYTE_EN(off, len) \
338 ((((0x1 << (len)) - 1) << ((off) & 0x3)) << PEXCADRS_BYTE_EN_SHIFT)
339 #define MK_PEXCADRS(cmd, addr, size) \
340 ((cmd) | MK_PEXCADRS_BYTE_EN(addr, size) | ((addr) & ~0x3))
341 static uint32_t config_read_pciex_rc(unsigned int __iomem
*base
,
342 uint32_t where
, uint32_t size
)
344 PEX_OUT(base
, PEXCADRS
, MK_PEXCADRS(PEXCADRS_CMD_READ
, where
, size
));
345 return (PEX_IN(base
, PEXCRDATA
)
346 >> ((where
& (4 - size
)) * 8)) & ((0x1 << (size
* 8)) - 1);
349 static void config_write_pciex_rc(unsigned int __iomem
*base
, uint32_t where
,
350 uint32_t size
, uint32_t val
)
354 data
= (val
& ((0x1 << (size
* 8)) - 1)) << ((where
& (4 - size
)) * 8);
355 PEX_OUT(base
, PEXCADRS
, MK_PEXCADRS(PEXCADRS_CMD_WRITE
, where
, size
));
356 PEX_OUT(base
, PEXCWDATA
, data
);
361 * On SCC PCIEXC, one device is seen on all 32 dev_no.
362 * As SCC PCIEXC can have only one device on the bus, we look only one dev_no.
365 static int scc_pciex_read_config(struct pci_bus
*bus
, unsigned int devfn
,
366 int where
, int size
, unsigned int *val
)
368 struct device_node
*dn
;
369 struct pci_controller
*phb
;
372 phb
= pci_find_hose_for_OF_device(dn
);
374 if (bus
->number
== phb
->first_busno
&& PCI_SLOT(devfn
) != 1) {
376 return PCIBIOS_DEVICE_NOT_FOUND
;
379 if (bus
->number
== 0 && PCI_SLOT(devfn
) == 0)
380 *val
= config_read_pciex_rc(phb
->cfg_addr
, where
, size
);
382 *val
= config_read_pciex_dev(phb
->cfg_addr
, bus
->number
,
383 PCI_SLOT(devfn
), PCI_FUNC(devfn
), where
, size
);
385 return PCIBIOS_SUCCESSFUL
;
388 static int scc_pciex_write_config(struct pci_bus
*bus
, unsigned int devfn
,
389 int where
, int size
, unsigned int val
)
391 struct device_node
*dn
;
392 struct pci_controller
*phb
;
395 phb
= pci_find_hose_for_OF_device(dn
);
397 if (bus
->number
== phb
->first_busno
&& PCI_SLOT(devfn
) != 1)
398 return PCIBIOS_DEVICE_NOT_FOUND
;
400 if (bus
->number
== 0 && PCI_SLOT(devfn
) == 0)
401 config_write_pciex_rc(phb
->cfg_addr
, where
, size
, val
);
403 config_write_pciex_dev(phb
->cfg_addr
, bus
->number
,
404 PCI_SLOT(devfn
), PCI_FUNC(devfn
), where
, size
, val
);
405 return PCIBIOS_SUCCESSFUL
;
408 static struct pci_ops scc_pciex_pci_ops
= {
409 scc_pciex_read_config
,
410 scc_pciex_write_config
,
413 static void pciex_clear_intr_all(unsigned int __iomem
*base
)
415 PEX_OUT(base
, PEXAERRSTS
, 0xffffffff);
416 PEX_OUT(base
, PEXPRERRSTS
, 0xffffffff);
417 PEX_OUT(base
, PEXINTSTS
, 0xffffffff);
421 static void pciex_disable_intr_all(unsigned int *base
)
423 PEX_OUT(base
, PEXINTMASK
, 0x0);
424 PEX_OUT(base
, PEXAERRMASK
, 0x0);
425 PEX_OUT(base
, PEXPRERRMASK
, 0x0);
426 PEX_OUT(base
, PEXVDMASK
, 0x0);
430 static void pciex_enable_intr_all(unsigned int __iomem
*base
)
432 PEX_OUT(base
, PEXINTMASK
, 0x0000e7f1);
433 PEX_OUT(base
, PEXAERRMASK
, 0x03ff01ff);
434 PEX_OUT(base
, PEXPRERRMASK
, 0x0001010f);
435 PEX_OUT(base
, PEXVDMASK
, 0x00000001);
438 static void pciex_check_status(unsigned int __iomem
*base
)
441 uint32_t intsts
, aerr
, prerr
, rcvcp
, lenerr
;
444 intsts
= PEX_IN(base
, PEXINTSTS
);
445 aerr
= PEX_IN(base
, PEXAERRSTS
);
446 prerr
= PEX_IN(base
, PEXPRERRSTS
);
447 rcvcp
= PEX_IN(base
, PEXRCVCPLIDA
);
448 lenerr
= PEX_IN(base
, PEXLENERRIDA
);
450 if (intsts
|| aerr
|| prerr
|| rcvcp
|| lenerr
)
453 pr_info("PCEXC interrupt!!\n");
454 pr_info("PEXINTSTS :0x%08x\n", intsts
);
455 pr_info("PEXAERRSTS :0x%08x\n", aerr
);
456 pr_info("PEXPRERRSTS :0x%08x\n", prerr
);
457 pr_info("PEXRCVCPLIDA :0x%08x\n", rcvcp
);
458 pr_info("PEXLENERRIDA :0x%08x\n", lenerr
);
460 /* print detail of Protection Error */
461 if (intsts
& 0x00004000) {
463 for (i
= 0; i
< 4; i
++) {
466 maea
= PEX_IN(base
, PEXMAEA(i
));
467 maec
= PEX_IN(base
, PEXMAEC(i
));
468 pr_info("PEXMAEC%d :0x%08x\n", i
, maec
);
469 pr_info("PEXMAEA%d :0x%08x\n", i
, maea
);
475 pciex_clear_intr_all(base
);
478 static irqreturn_t
pciex_handle_internal_irq(int irq
, void *dev_id
)
480 struct pci_controller
*phb
= dev_id
;
482 pr_debug("PCIEX:pciex_handle_internal_irq(irq=%d)\n", irq
);
484 BUG_ON(phb
->cfg_addr
== NULL
);
486 pciex_check_status(phb
->cfg_addr
);
491 static __init
int celleb_setup_pciex(struct device_node
*node
,
492 struct pci_controller
*phb
)
498 /* SMMIO registers; used inside this file */
499 if (of_address_to_resource(node
, 0, &r
)) {
500 pr_err("PCIEXC:Failed to get config resource.\n");
503 phb
->cfg_addr
= ioremap(r
.start
, r
.end
- r
.start
+ 1);
504 if (!phb
->cfg_addr
) {
505 pr_err("PCIEXC:Failed to remap SMMIO region.\n");
509 /* Not use cfg_data, cmd and data regs are near address reg */
510 phb
->cfg_data
= NULL
;
513 phb
->ops
= &scc_pciex_pci_ops
;
515 /* internal interrupt handler */
516 if (of_irq_map_one(node
, 1, &oirq
)) {
517 pr_err("PCIEXC:Failed to map irq\n");
520 virq
= irq_create_of_mapping(oirq
.controller
, oirq
.specifier
,
522 if (request_irq(virq
, pciex_handle_internal_irq
,
523 IRQF_DISABLED
, "pciex", (void *)phb
)) {
524 pr_err("PCIEXC:Failed to request irq\n");
528 /* enable all interrupts */
529 pciex_clear_intr_all(phb
->cfg_addr
);
530 pciex_enable_intr_all(phb
->cfg_addr
);
536 phb
->cfg_data
= NULL
;
538 iounmap(phb
->cfg_addr
);
539 phb
->cfg_addr
= NULL
;
543 struct celleb_phb_spec celleb_pciex_spec __initdata
= {
544 .setup
= celleb_setup_pciex
,
545 .ops
= &scc_pciex_ops
,
546 .iowa_init
= &scc_pciex_iowa_init
,