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); \
220 __le##size *dst = b; \
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 __le##size *src = b; \
235 for (; c != 0; c--, src++) \
236 __scc_pciex_out##name(bus->phb, le##size##_to_cpu(*src), p); \
239 #define cpu_to_le8(x) (x)
240 #define le8_to_cpu(x) (x)
242 PCIEX_PIO_FUNC(16, w
)
243 PCIEX_PIO_FUNC(32, l
)
245 static struct ppc_pci_io scc_pciex_ops
= {
246 .readb
= scc_pciex_readb
,
247 .readw
= scc_pciex_readw
,
248 .readl
= scc_pciex_readl
,
249 .readq
= scc_pciex_readq
,
250 .readw_be
= scc_pciex_readw_be
,
251 .readl_be
= scc_pciex_readl_be
,
252 .readq_be
= scc_pciex_readq_be
,
253 .readsb
= scc_pciex_readsb
,
254 .readsw
= scc_pciex_readsw
,
255 .readsl
= scc_pciex_readsl
,
256 .memcpy_fromio
= scc_pciex_memcpy_fromio
,
257 .inb
= scc_pciex_inb
,
258 .inw
= scc_pciex_inw
,
259 .inl
= scc_pciex_inl
,
260 .outb
= scc_pciex_outb
,
261 .outw
= scc_pciex_outw
,
262 .outl
= scc_pciex_outl
,
263 .insb
= scc_pciex_insb
,
264 .insw
= scc_pciex_insw
,
265 .insl
= scc_pciex_insl
,
266 .outsb
= scc_pciex_outsb
,
267 .outsw
= scc_pciex_outsw
,
268 .outsl
= scc_pciex_outsl
,
271 static int __init
scc_pciex_iowa_init(struct iowa_bus
*bus
, void *data
)
273 dma_addr_t dummy_page_da
;
276 dummy_page_va
= kmalloc(PAGE_SIZE
, GFP_KERNEL
);
277 if (!dummy_page_va
) {
278 pr_err("PCIEX:Alloc dummy_page_va failed\n");
282 dummy_page_da
= dma_map_single(bus
->phb
->parent
, dummy_page_va
,
283 PAGE_SIZE
, DMA_FROM_DEVICE
);
284 if (dma_mapping_error(bus
->phb
->parent
, dummy_page_da
)) {
285 pr_err("PCIEX:Map dummy page failed.\n");
286 kfree(dummy_page_va
);
290 PEX_OUT(bus
->phb
->cfg_addr
, PEXDMRDADR0
, dummy_page_da
);
296 * config space access
298 #define MK_PEXDADRS(bus_no, dev_no, func_no, addr) \
299 ((uint32_t)(((addr) & ~0x3UL) | \
300 ((bus_no) << PEXDADRS_BUSNO_SHIFT) | \
301 ((dev_no) << PEXDADRS_DEVNO_SHIFT) | \
302 ((func_no) << PEXDADRS_FUNCNO_SHIFT)))
304 #define MK_PEXDCMND_BYTE_EN(addr, size) \
305 ((((0x1 << (size))-1) << ((addr) & 0x3)) << PEXDCMND_BYTE_EN_SHIFT)
306 #define MK_PEXDCMND(cmd, addr, size) ((cmd) | MK_PEXDCMND_BYTE_EN(addr, size))
308 static uint32_t config_read_pciex_dev(unsigned int __iomem
*base
,
309 uint64_t bus_no
, uint64_t dev_no
, uint64_t func_no
,
310 uint64_t off
, uint64_t size
)
315 addr
= MK_PEXDADRS(bus_no
, dev_no
, func_no
, off
);
316 cmd
= MK_PEXDCMND(PEXDCMND_CONFIG_READ
, off
, size
);
317 PEX_OUT(base
, PEXDADRS
, addr
);
318 PEX_OUT(base
, PEXDCMND
, cmd
);
319 ret
= (PEX_IN(base
, PEXDRDATA
)
320 >> ((off
& (4-size
)) * 8)) & ((0x1 << (size
* 8)) - 1);
324 static void config_write_pciex_dev(unsigned int __iomem
*base
, uint64_t bus_no
,
325 uint64_t dev_no
, uint64_t func_no
, uint64_t off
, uint64_t size
,
330 addr
= MK_PEXDADRS(bus_no
, dev_no
, func_no
, off
);
331 cmd
= MK_PEXDCMND(PEXDCMND_CONFIG_WRITE
, off
, size
);
332 PEX_OUT(base
, PEXDADRS
, addr
);
333 PEX_OUT(base
, PEXDCMND
, cmd
);
334 PEX_OUT(base
, PEXDWDATA
,
335 (data
& ((0x1 << (size
* 8)) - 1)) << ((off
& (4-size
)) * 8));
338 #define MK_PEXCADRS_BYTE_EN(off, len) \
339 ((((0x1 << (len)) - 1) << ((off) & 0x3)) << PEXCADRS_BYTE_EN_SHIFT)
340 #define MK_PEXCADRS(cmd, addr, size) \
341 ((cmd) | MK_PEXCADRS_BYTE_EN(addr, size) | ((addr) & ~0x3))
342 static uint32_t config_read_pciex_rc(unsigned int __iomem
*base
,
343 uint32_t where
, uint32_t size
)
345 PEX_OUT(base
, PEXCADRS
, MK_PEXCADRS(PEXCADRS_CMD_READ
, where
, size
));
346 return (PEX_IN(base
, PEXCRDATA
)
347 >> ((where
& (4 - size
)) * 8)) & ((0x1 << (size
* 8)) - 1);
350 static void config_write_pciex_rc(unsigned int __iomem
*base
, uint32_t where
,
351 uint32_t size
, uint32_t val
)
355 data
= (val
& ((0x1 << (size
* 8)) - 1)) << ((where
& (4 - size
)) * 8);
356 PEX_OUT(base
, PEXCADRS
, MK_PEXCADRS(PEXCADRS_CMD_WRITE
, where
, size
));
357 PEX_OUT(base
, PEXCWDATA
, data
);
362 * On SCC PCIEXC, one device is seen on all 32 dev_no.
363 * As SCC PCIEXC can have only one device on the bus, we look only one dev_no.
366 static int scc_pciex_read_config(struct pci_bus
*bus
, unsigned int devfn
,
367 int where
, int size
, unsigned int *val
)
369 struct pci_controller
*phb
= pci_bus_to_host(bus
);
371 if (bus
->number
== phb
->first_busno
&& PCI_SLOT(devfn
) != 1) {
373 return PCIBIOS_DEVICE_NOT_FOUND
;
376 if (bus
->number
== 0 && PCI_SLOT(devfn
) == 0)
377 *val
= config_read_pciex_rc(phb
->cfg_addr
, where
, size
);
379 *val
= config_read_pciex_dev(phb
->cfg_addr
, bus
->number
,
380 PCI_SLOT(devfn
), PCI_FUNC(devfn
), where
, size
);
382 return PCIBIOS_SUCCESSFUL
;
385 static int scc_pciex_write_config(struct pci_bus
*bus
, unsigned int devfn
,
386 int where
, int size
, unsigned int val
)
388 struct pci_controller
*phb
= pci_bus_to_host(bus
);
390 if (bus
->number
== phb
->first_busno
&& PCI_SLOT(devfn
) != 1)
391 return PCIBIOS_DEVICE_NOT_FOUND
;
393 if (bus
->number
== 0 && PCI_SLOT(devfn
) == 0)
394 config_write_pciex_rc(phb
->cfg_addr
, where
, size
, val
);
396 config_write_pciex_dev(phb
->cfg_addr
, bus
->number
,
397 PCI_SLOT(devfn
), PCI_FUNC(devfn
), where
, size
, val
);
398 return PCIBIOS_SUCCESSFUL
;
401 static struct pci_ops scc_pciex_pci_ops
= {
402 scc_pciex_read_config
,
403 scc_pciex_write_config
,
406 static void pciex_clear_intr_all(unsigned int __iomem
*base
)
408 PEX_OUT(base
, PEXAERRSTS
, 0xffffffff);
409 PEX_OUT(base
, PEXPRERRSTS
, 0xffffffff);
410 PEX_OUT(base
, PEXINTSTS
, 0xffffffff);
414 static void pciex_disable_intr_all(unsigned int *base
)
416 PEX_OUT(base
, PEXINTMASK
, 0x0);
417 PEX_OUT(base
, PEXAERRMASK
, 0x0);
418 PEX_OUT(base
, PEXPRERRMASK
, 0x0);
419 PEX_OUT(base
, PEXVDMASK
, 0x0);
423 static void pciex_enable_intr_all(unsigned int __iomem
*base
)
425 PEX_OUT(base
, PEXINTMASK
, 0x0000e7f1);
426 PEX_OUT(base
, PEXAERRMASK
, 0x03ff01ff);
427 PEX_OUT(base
, PEXPRERRMASK
, 0x0001010f);
428 PEX_OUT(base
, PEXVDMASK
, 0x00000001);
431 static void pciex_check_status(unsigned int __iomem
*base
)
434 uint32_t intsts
, aerr
, prerr
, rcvcp
, lenerr
;
437 intsts
= PEX_IN(base
, PEXINTSTS
);
438 aerr
= PEX_IN(base
, PEXAERRSTS
);
439 prerr
= PEX_IN(base
, PEXPRERRSTS
);
440 rcvcp
= PEX_IN(base
, PEXRCVCPLIDA
);
441 lenerr
= PEX_IN(base
, PEXLENERRIDA
);
443 if (intsts
|| aerr
|| prerr
|| rcvcp
|| lenerr
)
446 pr_info("PCEXC interrupt!!\n");
447 pr_info("PEXINTSTS :0x%08x\n", intsts
);
448 pr_info("PEXAERRSTS :0x%08x\n", aerr
);
449 pr_info("PEXPRERRSTS :0x%08x\n", prerr
);
450 pr_info("PEXRCVCPLIDA :0x%08x\n", rcvcp
);
451 pr_info("PEXLENERRIDA :0x%08x\n", lenerr
);
453 /* print detail of Protection Error */
454 if (intsts
& 0x00004000) {
456 for (i
= 0; i
< 4; i
++) {
459 maea
= PEX_IN(base
, PEXMAEA(i
));
460 maec
= PEX_IN(base
, PEXMAEC(i
));
461 pr_info("PEXMAEC%d :0x%08x\n", i
, maec
);
462 pr_info("PEXMAEA%d :0x%08x\n", i
, maea
);
468 pciex_clear_intr_all(base
);
471 static irqreturn_t
pciex_handle_internal_irq(int irq
, void *dev_id
)
473 struct pci_controller
*phb
= dev_id
;
475 pr_debug("PCIEX:pciex_handle_internal_irq(irq=%d)\n", irq
);
477 BUG_ON(phb
->cfg_addr
== NULL
);
479 pciex_check_status(phb
->cfg_addr
);
484 static __init
int celleb_setup_pciex(struct device_node
*node
,
485 struct pci_controller
*phb
)
491 /* SMMIO registers; used inside this file */
492 if (of_address_to_resource(node
, 0, &r
)) {
493 pr_err("PCIEXC:Failed to get config resource.\n");
496 phb
->cfg_addr
= ioremap(r
.start
, r
.end
- r
.start
+ 1);
497 if (!phb
->cfg_addr
) {
498 pr_err("PCIEXC:Failed to remap SMMIO region.\n");
502 /* Not use cfg_data, cmd and data regs are near address reg */
503 phb
->cfg_data
= NULL
;
506 phb
->ops
= &scc_pciex_pci_ops
;
508 /* internal interrupt handler */
509 if (of_irq_map_one(node
, 1, &oirq
)) {
510 pr_err("PCIEXC:Failed to map irq\n");
513 virq
= irq_create_of_mapping(oirq
.controller
, oirq
.specifier
,
515 if (request_irq(virq
, pciex_handle_internal_irq
,
516 IRQF_DISABLED
, "pciex", (void *)phb
)) {
517 pr_err("PCIEXC:Failed to request irq\n");
521 /* enable all interrupts */
522 pciex_clear_intr_all(phb
->cfg_addr
);
523 pciex_enable_intr_all(phb
->cfg_addr
);
529 phb
->cfg_data
= NULL
;
531 iounmap(phb
->cfg_addr
);
532 phb
->cfg_addr
= NULL
;
536 struct celleb_phb_spec celleb_pciex_spec __initdata
= {
537 .setup
= celleb_setup_pciex
,
538 .ops
= &scc_pciex_ops
,
539 .iowa_init
= &scc_pciex_iowa_init
,