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/slab.h>
27 #include <linux/init.h>
28 #include <linux/bootmem.h>
29 #include <linux/delay.h>
30 #include <linux/interrupt.h>
34 #include <asm/iommu.h>
35 #include <asm/byteorder.h>
37 #include "celleb_scc.h"
38 #include "celleb_pci.h"
40 #define PEX_IN(base, off) in_be32((void __iomem *)(base) + (off))
41 #define PEX_OUT(base, off, data) out_be32((void __iomem *)(base) + (off), (data))
43 static void scc_pciex_io_flush(struct iowa_bus
*bus
)
45 (void)PEX_IN(bus
->phb
->cfg_addr
, PEXDMRDEN0
);
49 * Memory space access to device on PCIEX
51 #define PCIEX_MMIO_READ(name, ret) \
52 static ret scc_pciex_##name(const PCI_IO_ADDR addr) \
54 ret val = __do_##name(addr); \
55 scc_pciex_io_flush(iowa_mem_find_bus(addr)); \
59 #define PCIEX_MMIO_READ_STR(name) \
60 static void scc_pciex_##name(const PCI_IO_ADDR addr, void *buf, \
61 unsigned long count) \
63 __do_##name(addr, buf, count); \
64 scc_pciex_io_flush(iowa_mem_find_bus(addr)); \
67 PCIEX_MMIO_READ(readb
, u8
)
68 PCIEX_MMIO_READ(readw
, u16
)
69 PCIEX_MMIO_READ(readl
, u32
)
70 PCIEX_MMIO_READ(readq
, u64
)
71 PCIEX_MMIO_READ(readw_be
, u16
)
72 PCIEX_MMIO_READ(readl_be
, u32
)
73 PCIEX_MMIO_READ(readq_be
, u64
)
74 PCIEX_MMIO_READ_STR(readsb
)
75 PCIEX_MMIO_READ_STR(readsw
)
76 PCIEX_MMIO_READ_STR(readsl
)
78 static void scc_pciex_memcpy_fromio(void *dest
, const PCI_IO_ADDR src
,
81 __do_memcpy_fromio(dest
, src
, n
);
82 scc_pciex_io_flush(iowa_mem_find_bus(src
));
86 * I/O port access to devices on PCIEX.
89 static inline unsigned long get_bus_address(struct pci_controller
*phb
,
92 return port
- ((unsigned long)(phb
->io_base_virt
) - _IO_BASE
);
95 static u32
scc_pciex_read_port(struct pci_controller
*phb
,
96 unsigned long port
, int size
)
98 unsigned int byte_enable
;
99 unsigned int cmd
, shift
;
103 BUG_ON(((port
& 0x3ul
) + size
) > 4);
105 addr
= get_bus_address(phb
, port
);
106 shift
= addr
& 0x3ul
;
107 byte_enable
= ((1 << size
) - 1) << shift
;
108 cmd
= PEXDCMND_IO_READ
| (byte_enable
<< PEXDCMND_BYTE_EN_SHIFT
);
109 PEX_OUT(phb
->cfg_addr
, PEXDADRS
, (addr
& ~0x3ul
));
110 PEX_OUT(phb
->cfg_addr
, PEXDCMND
, cmd
);
111 data
= PEX_IN(phb
->cfg_addr
, PEXDRDATA
);
112 ret
= (data
>> (shift
* 8)) & (0xFFFFFFFF >> ((4 - size
) * 8));
114 pr_debug("PCIEX:PIO READ:port=0x%lx, addr=0x%lx, size=%d, be=%x,"
115 " cmd=%x, data=%x, ret=%x\n", port
, addr
, size
, byte_enable
,
121 static void scc_pciex_write_port(struct pci_controller
*phb
,
122 unsigned long port
, int size
, u32 val
)
124 unsigned int byte_enable
;
125 unsigned int cmd
, shift
;
129 BUG_ON(((port
& 0x3ul
) + size
) > 4);
131 addr
= get_bus_address(phb
, port
);
132 shift
= addr
& 0x3ul
;
133 byte_enable
= ((1 << size
) - 1) << shift
;
134 cmd
= PEXDCMND_IO_WRITE
| (byte_enable
<< PEXDCMND_BYTE_EN_SHIFT
);
135 data
= (val
& (0xFFFFFFFF >> (4 - size
) * 8)) << (shift
* 8);
136 PEX_OUT(phb
->cfg_addr
, PEXDADRS
, (addr
& ~0x3ul
));
137 PEX_OUT(phb
->cfg_addr
, PEXDCMND
, cmd
);
138 PEX_OUT(phb
->cfg_addr
, PEXDWDATA
, data
);
140 pr_debug("PCIEX:PIO WRITE:port=0x%lx, addr=%lx, size=%d, val=%x,"
141 " be=%x, cmd=%x, data=%x\n", port
, addr
, size
, val
,
142 byte_enable
, cmd
, data
);
145 static u8
__scc_pciex_inb(struct pci_controller
*phb
, unsigned long port
)
147 return (u8
)scc_pciex_read_port(phb
, port
, 1);
150 static u16
__scc_pciex_inw(struct pci_controller
*phb
, unsigned long port
)
153 if ((port
& 0x3ul
) < 3)
154 data
= scc_pciex_read_port(phb
, port
, 2);
156 u32 d1
= scc_pciex_read_port(phb
, port
, 1);
157 u32 d2
= scc_pciex_read_port(phb
, port
+ 1, 1);
158 data
= d1
| (d2
<< 8);
163 static u32
__scc_pciex_inl(struct pci_controller
*phb
, unsigned long port
)
165 unsigned int mod
= port
& 0x3ul
;
168 data
= scc_pciex_read_port(phb
, port
, 4);
170 u32 d1
= scc_pciex_read_port(phb
, port
, 4 - mod
);
171 u32 d2
= scc_pciex_read_port(phb
, port
+ 1, mod
);
172 data
= d1
| (d2
<< (mod
* 8));
177 static void __scc_pciex_outb(struct pci_controller
*phb
,
178 u8 val
, unsigned long port
)
180 scc_pciex_write_port(phb
, port
, 1, (u32
)val
);
183 static void __scc_pciex_outw(struct pci_controller
*phb
,
184 u16 val
, unsigned long port
)
186 if ((port
& 0x3ul
) < 3)
187 scc_pciex_write_port(phb
, port
, 2, (u32
)val
);
189 u32 d1
= val
& 0x000000FF;
190 u32 d2
= (val
& 0x0000FF00) >> 8;
191 scc_pciex_write_port(phb
, port
, 1, d1
);
192 scc_pciex_write_port(phb
, port
+ 1, 1, d2
);
196 static void __scc_pciex_outl(struct pci_controller
*phb
,
197 u32 val
, unsigned long port
)
199 unsigned int mod
= port
& 0x3ul
;
201 scc_pciex_write_port(phb
, port
, 4, val
);
203 u32 d1
= val
& (0xFFFFFFFFul
>> (mod
* 8));
204 u32 d2
= val
>> ((4 - mod
) * 8);
205 scc_pciex_write_port(phb
, port
, 4 - mod
, d1
);
206 scc_pciex_write_port(phb
, port
+ 1, mod
, d2
);
210 #define PCIEX_PIO_FUNC(size, name) \
211 static u##size scc_pciex_in##name(unsigned long port) \
213 struct iowa_bus *bus = iowa_pio_find_bus(port); \
214 u##size data = __scc_pciex_in##name(bus->phb, port); \
215 scc_pciex_io_flush(bus); \
218 static void scc_pciex_ins##name(unsigned long p, void *b, unsigned long c) \
220 struct iowa_bus *bus = iowa_pio_find_bus(p); \
221 __le##size *dst = b; \
222 for (; c != 0; c--, dst++) \
223 *dst = cpu_to_le##size(__scc_pciex_in##name(bus->phb, p)); \
224 scc_pciex_io_flush(bus); \
226 static void scc_pciex_out##name(u##size val, unsigned long port) \
228 struct iowa_bus *bus = iowa_pio_find_bus(port); \
229 __scc_pciex_out##name(bus->phb, val, port); \
231 static void scc_pciex_outs##name(unsigned long p, const void *b, \
234 struct iowa_bus *bus = iowa_pio_find_bus(p); \
235 const __le##size *src = b; \
236 for (; c != 0; c--, src++) \
237 __scc_pciex_out##name(bus->phb, le##size##_to_cpu(*src), p); \
240 #define cpu_to_le8(x) (x)
241 #define le8_to_cpu(x) (x)
243 PCIEX_PIO_FUNC(16, w
)
244 PCIEX_PIO_FUNC(32, l
)
246 static struct ppc_pci_io scc_pciex_ops
= {
247 .readb
= scc_pciex_readb
,
248 .readw
= scc_pciex_readw
,
249 .readl
= scc_pciex_readl
,
250 .readq
= scc_pciex_readq
,
251 .readw_be
= scc_pciex_readw_be
,
252 .readl_be
= scc_pciex_readl_be
,
253 .readq_be
= scc_pciex_readq_be
,
254 .readsb
= scc_pciex_readsb
,
255 .readsw
= scc_pciex_readsw
,
256 .readsl
= scc_pciex_readsl
,
257 .memcpy_fromio
= scc_pciex_memcpy_fromio
,
258 .inb
= scc_pciex_inb
,
259 .inw
= scc_pciex_inw
,
260 .inl
= scc_pciex_inl
,
261 .outb
= scc_pciex_outb
,
262 .outw
= scc_pciex_outw
,
263 .outl
= scc_pciex_outl
,
264 .insb
= scc_pciex_insb
,
265 .insw
= scc_pciex_insw
,
266 .insl
= scc_pciex_insl
,
267 .outsb
= scc_pciex_outsb
,
268 .outsw
= scc_pciex_outsw
,
269 .outsl
= scc_pciex_outsl
,
272 static int __init
scc_pciex_iowa_init(struct iowa_bus
*bus
, void *data
)
274 dma_addr_t dummy_page_da
;
277 dummy_page_va
= kmalloc(PAGE_SIZE
, GFP_KERNEL
);
278 if (!dummy_page_va
) {
279 pr_err("PCIEX:Alloc dummy_page_va failed\n");
283 dummy_page_da
= dma_map_single(bus
->phb
->parent
, dummy_page_va
,
284 PAGE_SIZE
, DMA_FROM_DEVICE
);
285 if (dma_mapping_error(bus
->phb
->parent
, dummy_page_da
)) {
286 pr_err("PCIEX:Map dummy page failed.\n");
287 kfree(dummy_page_va
);
291 PEX_OUT(bus
->phb
->cfg_addr
, PEXDMRDADR0
, dummy_page_da
);
297 * config space access
299 #define MK_PEXDADRS(bus_no, dev_no, func_no, addr) \
300 ((uint32_t)(((addr) & ~0x3UL) | \
301 ((bus_no) << PEXDADRS_BUSNO_SHIFT) | \
302 ((dev_no) << PEXDADRS_DEVNO_SHIFT) | \
303 ((func_no) << PEXDADRS_FUNCNO_SHIFT)))
305 #define MK_PEXDCMND_BYTE_EN(addr, size) \
306 ((((0x1 << (size))-1) << ((addr) & 0x3)) << PEXDCMND_BYTE_EN_SHIFT)
307 #define MK_PEXDCMND(cmd, addr, size) ((cmd) | MK_PEXDCMND_BYTE_EN(addr, size))
309 static uint32_t config_read_pciex_dev(unsigned int __iomem
*base
,
310 uint64_t bus_no
, uint64_t dev_no
, uint64_t func_no
,
311 uint64_t off
, uint64_t size
)
316 addr
= MK_PEXDADRS(bus_no
, dev_no
, func_no
, off
);
317 cmd
= MK_PEXDCMND(PEXDCMND_CONFIG_READ
, off
, size
);
318 PEX_OUT(base
, PEXDADRS
, addr
);
319 PEX_OUT(base
, PEXDCMND
, cmd
);
320 ret
= (PEX_IN(base
, PEXDRDATA
)
321 >> ((off
& (4-size
)) * 8)) & ((0x1 << (size
* 8)) - 1);
325 static void config_write_pciex_dev(unsigned int __iomem
*base
, uint64_t bus_no
,
326 uint64_t dev_no
, uint64_t func_no
, uint64_t off
, uint64_t size
,
331 addr
= MK_PEXDADRS(bus_no
, dev_no
, func_no
, off
);
332 cmd
= MK_PEXDCMND(PEXDCMND_CONFIG_WRITE
, off
, size
);
333 PEX_OUT(base
, PEXDADRS
, addr
);
334 PEX_OUT(base
, PEXDCMND
, cmd
);
335 PEX_OUT(base
, PEXDWDATA
,
336 (data
& ((0x1 << (size
* 8)) - 1)) << ((off
& (4-size
)) * 8));
339 #define MK_PEXCADRS_BYTE_EN(off, len) \
340 ((((0x1 << (len)) - 1) << ((off) & 0x3)) << PEXCADRS_BYTE_EN_SHIFT)
341 #define MK_PEXCADRS(cmd, addr, size) \
342 ((cmd) | MK_PEXCADRS_BYTE_EN(addr, size) | ((addr) & ~0x3))
343 static uint32_t config_read_pciex_rc(unsigned int __iomem
*base
,
344 uint32_t where
, uint32_t size
)
346 PEX_OUT(base
, PEXCADRS
, MK_PEXCADRS(PEXCADRS_CMD_READ
, where
, size
));
347 return (PEX_IN(base
, PEXCRDATA
)
348 >> ((where
& (4 - size
)) * 8)) & ((0x1 << (size
* 8)) - 1);
351 static void config_write_pciex_rc(unsigned int __iomem
*base
, uint32_t where
,
352 uint32_t size
, uint32_t val
)
356 data
= (val
& ((0x1 << (size
* 8)) - 1)) << ((where
& (4 - size
)) * 8);
357 PEX_OUT(base
, PEXCADRS
, MK_PEXCADRS(PEXCADRS_CMD_WRITE
, where
, size
));
358 PEX_OUT(base
, PEXCWDATA
, data
);
363 * On SCC PCIEXC, one device is seen on all 32 dev_no.
364 * As SCC PCIEXC can have only one device on the bus, we look only one dev_no.
367 static int scc_pciex_read_config(struct pci_bus
*bus
, unsigned int devfn
,
368 int where
, int size
, unsigned int *val
)
370 struct pci_controller
*phb
= pci_bus_to_host(bus
);
372 if (bus
->number
== phb
->first_busno
&& PCI_SLOT(devfn
) != 1) {
374 return PCIBIOS_DEVICE_NOT_FOUND
;
377 if (bus
->number
== 0 && PCI_SLOT(devfn
) == 0)
378 *val
= config_read_pciex_rc(phb
->cfg_addr
, where
, size
);
380 *val
= config_read_pciex_dev(phb
->cfg_addr
, bus
->number
,
381 PCI_SLOT(devfn
), PCI_FUNC(devfn
), where
, size
);
383 return PCIBIOS_SUCCESSFUL
;
386 static int scc_pciex_write_config(struct pci_bus
*bus
, unsigned int devfn
,
387 int where
, int size
, unsigned int val
)
389 struct pci_controller
*phb
= pci_bus_to_host(bus
);
391 if (bus
->number
== phb
->first_busno
&& PCI_SLOT(devfn
) != 1)
392 return PCIBIOS_DEVICE_NOT_FOUND
;
394 if (bus
->number
== 0 && PCI_SLOT(devfn
) == 0)
395 config_write_pciex_rc(phb
->cfg_addr
, where
, size
, val
);
397 config_write_pciex_dev(phb
->cfg_addr
, bus
->number
,
398 PCI_SLOT(devfn
), PCI_FUNC(devfn
), where
, size
, val
);
399 return PCIBIOS_SUCCESSFUL
;
402 static struct pci_ops scc_pciex_pci_ops
= {
403 scc_pciex_read_config
,
404 scc_pciex_write_config
,
407 static void pciex_clear_intr_all(unsigned int __iomem
*base
)
409 PEX_OUT(base
, PEXAERRSTS
, 0xffffffff);
410 PEX_OUT(base
, PEXPRERRSTS
, 0xffffffff);
411 PEX_OUT(base
, PEXINTSTS
, 0xffffffff);
415 static void pciex_disable_intr_all(unsigned int *base
)
417 PEX_OUT(base
, PEXINTMASK
, 0x0);
418 PEX_OUT(base
, PEXAERRMASK
, 0x0);
419 PEX_OUT(base
, PEXPRERRMASK
, 0x0);
420 PEX_OUT(base
, PEXVDMASK
, 0x0);
424 static void pciex_enable_intr_all(unsigned int __iomem
*base
)
426 PEX_OUT(base
, PEXINTMASK
, 0x0000e7f1);
427 PEX_OUT(base
, PEXAERRMASK
, 0x03ff01ff);
428 PEX_OUT(base
, PEXPRERRMASK
, 0x0001010f);
429 PEX_OUT(base
, PEXVDMASK
, 0x00000001);
432 static void pciex_check_status(unsigned int __iomem
*base
)
435 uint32_t intsts
, aerr
, prerr
, rcvcp
, lenerr
;
438 intsts
= PEX_IN(base
, PEXINTSTS
);
439 aerr
= PEX_IN(base
, PEXAERRSTS
);
440 prerr
= PEX_IN(base
, PEXPRERRSTS
);
441 rcvcp
= PEX_IN(base
, PEXRCVCPLIDA
);
442 lenerr
= PEX_IN(base
, PEXLENERRIDA
);
444 if (intsts
|| aerr
|| prerr
|| rcvcp
|| lenerr
)
447 pr_info("PCEXC interrupt!!\n");
448 pr_info("PEXINTSTS :0x%08x\n", intsts
);
449 pr_info("PEXAERRSTS :0x%08x\n", aerr
);
450 pr_info("PEXPRERRSTS :0x%08x\n", prerr
);
451 pr_info("PEXRCVCPLIDA :0x%08x\n", rcvcp
);
452 pr_info("PEXLENERRIDA :0x%08x\n", lenerr
);
454 /* print detail of Protection Error */
455 if (intsts
& 0x00004000) {
457 for (i
= 0; i
< 4; i
++) {
460 maea
= PEX_IN(base
, PEXMAEA(i
));
461 maec
= PEX_IN(base
, PEXMAEC(i
));
462 pr_info("PEXMAEC%d :0x%08x\n", i
, maec
);
463 pr_info("PEXMAEA%d :0x%08x\n", i
, maea
);
469 pciex_clear_intr_all(base
);
472 static irqreturn_t
pciex_handle_internal_irq(int irq
, void *dev_id
)
474 struct pci_controller
*phb
= dev_id
;
476 pr_debug("PCIEX:pciex_handle_internal_irq(irq=%d)\n", irq
);
478 BUG_ON(phb
->cfg_addr
== NULL
);
480 pciex_check_status(phb
->cfg_addr
);
485 static __init
int celleb_setup_pciex(struct device_node
*node
,
486 struct pci_controller
*phb
)
492 /* SMMIO registers; used inside this file */
493 if (of_address_to_resource(node
, 0, &r
)) {
494 pr_err("PCIEXC:Failed to get config resource.\n");
497 phb
->cfg_addr
= ioremap(r
.start
, resource_size(&r
));
498 if (!phb
->cfg_addr
) {
499 pr_err("PCIEXC:Failed to remap SMMIO region.\n");
503 /* Not use cfg_data, cmd and data regs are near address reg */
504 phb
->cfg_data
= NULL
;
507 phb
->ops
= &scc_pciex_pci_ops
;
509 /* internal interrupt handler */
510 if (of_irq_map_one(node
, 1, &oirq
)) {
511 pr_err("PCIEXC:Failed to map irq\n");
514 virq
= irq_create_of_mapping(oirq
.controller
, oirq
.specifier
,
516 if (request_irq(virq
, pciex_handle_internal_irq
,
517 0, "pciex", (void *)phb
)) {
518 pr_err("PCIEXC:Failed to request irq\n");
522 /* enable all interrupts */
523 pciex_clear_intr_all(phb
->cfg_addr
);
524 pciex_enable_intr_all(phb
->cfg_addr
);
530 phb
->cfg_data
= NULL
;
532 iounmap(phb
->cfg_addr
);
533 phb
->cfg_addr
= NULL
;
537 struct celleb_phb_spec celleb_pciex_spec __initdata
= {
538 .setup
= celleb_setup_pciex
,
539 .ops
= &scc_pciex_ops
,
540 .iowa_init
= &scc_pciex_iowa_init
,