2 * Ralink RT3662/RT3883 SoC PCI support
4 * Copyright (C) 2011-2013 Gabor Juhos <juhosg@openwrt.org>
6 * Parts of this file are based on Ralink's 2.6.21 BSP
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.
13 #include <linux/types.h>
14 #include <linux/pci.h>
16 #include <linux/init.h>
17 #include <linux/delay.h>
18 #include <linux/interrupt.h>
19 #include <linux/module.h>
21 #include <linux/of_irq.h>
22 #include <linux/of_pci.h>
23 #include <linux/platform_device.h>
25 #include <asm/mach-ralink/rt3883.h>
26 #include <asm/mach-ralink/ralink_regs.h>
28 #define RT3883_MEMORY_BASE 0x00000000
29 #define RT3883_MEMORY_SIZE 0x02000000
31 #define RT3883_PCI_REG_PCICFG 0x00
32 #define RT3883_PCICFG_P2P_BR_DEVNUM_M 0xf
33 #define RT3883_PCICFG_P2P_BR_DEVNUM_S 16
34 #define RT3883_PCICFG_PCIRST BIT(1)
35 #define RT3883_PCI_REG_PCIRAW 0x04
36 #define RT3883_PCI_REG_PCIINT 0x08
37 #define RT3883_PCI_REG_PCIENA 0x0c
39 #define RT3883_PCI_REG_CFGADDR 0x20
40 #define RT3883_PCI_REG_CFGDATA 0x24
41 #define RT3883_PCI_REG_MEMBASE 0x28
42 #define RT3883_PCI_REG_IOBASE 0x2c
43 #define RT3883_PCI_REG_ARBCTL 0x80
45 #define RT3883_PCI_REG_BASE(_x) (0x1000 + (_x) * 0x1000)
46 #define RT3883_PCI_REG_BAR0SETUP(_x) (RT3883_PCI_REG_BASE((_x)) + 0x10)
47 #define RT3883_PCI_REG_IMBASEBAR0(_x) (RT3883_PCI_REG_BASE((_x)) + 0x18)
48 #define RT3883_PCI_REG_ID(_x) (RT3883_PCI_REG_BASE((_x)) + 0x30)
49 #define RT3883_PCI_REG_CLASS(_x) (RT3883_PCI_REG_BASE((_x)) + 0x34)
50 #define RT3883_PCI_REG_SUBID(_x) (RT3883_PCI_REG_BASE((_x)) + 0x38)
51 #define RT3883_PCI_REG_STATUS(_x) (RT3883_PCI_REG_BASE((_x)) + 0x50)
53 #define RT3883_PCI_MODE_NONE 0
54 #define RT3883_PCI_MODE_PCI BIT(0)
55 #define RT3883_PCI_MODE_PCIE BIT(1)
56 #define RT3883_PCI_MODE_BOTH (RT3883_PCI_MODE_PCI | RT3883_PCI_MODE_PCIE)
58 #define RT3883_PCI_IRQ_COUNT 32
60 #define RT3883_P2P_BR_DEVNUM 1
62 struct rt3883_pci_controller
{
66 struct device_node
*intc_of_node
;
67 struct irq_domain
*irq_domain
;
69 struct pci_controller pci_controller
;
70 struct resource io_res
;
71 struct resource mem_res
;
76 static inline struct rt3883_pci_controller
*
77 pci_bus_to_rt3883_controller(struct pci_bus
*bus
)
79 struct pci_controller
*hose
;
81 hose
= (struct pci_controller
*) bus
->sysdata
;
82 return container_of(hose
, struct rt3883_pci_controller
, pci_controller
);
85 static inline u32
rt3883_pci_r32(struct rt3883_pci_controller
*rpc
,
88 return ioread32(rpc
->base
+ reg
);
91 static inline void rt3883_pci_w32(struct rt3883_pci_controller
*rpc
,
92 u32 val
, unsigned reg
)
94 iowrite32(val
, rpc
->base
+ reg
);
97 static inline u32
rt3883_pci_get_cfgaddr(unsigned int bus
, unsigned int slot
,
98 unsigned int func
, unsigned int where
)
100 return (bus
<< 16) | (slot
<< 11) | (func
<< 8) | (where
& 0xfc) |
104 static u32
rt3883_pci_read_cfg32(struct rt3883_pci_controller
*rpc
,
105 unsigned bus
, unsigned slot
,
106 unsigned func
, unsigned reg
)
112 address
= rt3883_pci_get_cfgaddr(bus
, slot
, func
, reg
);
114 spin_lock_irqsave(&rpc
->lock
, flags
);
115 rt3883_pci_w32(rpc
, address
, RT3883_PCI_REG_CFGADDR
);
116 ret
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_CFGDATA
);
117 spin_unlock_irqrestore(&rpc
->lock
, flags
);
122 static void rt3883_pci_write_cfg32(struct rt3883_pci_controller
*rpc
,
123 unsigned bus
, unsigned slot
,
124 unsigned func
, unsigned reg
, u32 val
)
129 address
= rt3883_pci_get_cfgaddr(bus
, slot
, func
, reg
);
131 spin_lock_irqsave(&rpc
->lock
, flags
);
132 rt3883_pci_w32(rpc
, address
, RT3883_PCI_REG_CFGADDR
);
133 rt3883_pci_w32(rpc
, val
, RT3883_PCI_REG_CFGDATA
);
134 spin_unlock_irqrestore(&rpc
->lock
, flags
);
137 static void rt3883_pci_irq_handler(unsigned int irq
, struct irq_desc
*desc
)
139 struct rt3883_pci_controller
*rpc
;
142 rpc
= irq_get_handler_data(irq
);
144 pending
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCIINT
) &
145 rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCIENA
);
148 spurious_interrupt();
153 unsigned bit
= __ffs(pending
);
155 irq
= irq_find_mapping(rpc
->irq_domain
, bit
);
156 generic_handle_irq(irq
);
158 pending
&= ~BIT(bit
);
162 static void rt3883_pci_irq_unmask(struct irq_data
*d
)
164 struct rt3883_pci_controller
*rpc
;
167 rpc
= irq_data_get_irq_chip_data(d
);
169 t
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCIENA
);
170 rt3883_pci_w32(rpc
, t
| BIT(d
->hwirq
), RT3883_PCI_REG_PCIENA
);
172 rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCIENA
);
175 static void rt3883_pci_irq_mask(struct irq_data
*d
)
177 struct rt3883_pci_controller
*rpc
;
180 rpc
= irq_data_get_irq_chip_data(d
);
182 t
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCIENA
);
183 rt3883_pci_w32(rpc
, t
& ~BIT(d
->hwirq
), RT3883_PCI_REG_PCIENA
);
185 rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCIENA
);
188 static struct irq_chip rt3883_pci_irq_chip
= {
189 .name
= "RT3883 PCI",
190 .irq_mask
= rt3883_pci_irq_mask
,
191 .irq_unmask
= rt3883_pci_irq_unmask
,
192 .irq_mask_ack
= rt3883_pci_irq_mask
,
195 static int rt3883_pci_irq_map(struct irq_domain
*d
, unsigned int irq
,
198 irq_set_chip_and_handler(irq
, &rt3883_pci_irq_chip
, handle_level_irq
);
199 irq_set_chip_data(irq
, d
->host_data
);
204 static const struct irq_domain_ops rt3883_pci_irq_domain_ops
= {
205 .map
= rt3883_pci_irq_map
,
206 .xlate
= irq_domain_xlate_onecell
,
209 static int rt3883_pci_irq_init(struct device
*dev
,
210 struct rt3883_pci_controller
*rpc
)
214 irq
= irq_of_parse_and_map(rpc
->intc_of_node
, 0);
216 dev_err(dev
, "%s has no IRQ",
217 of_node_full_name(rpc
->intc_of_node
));
221 /* disable all interrupts */
222 rt3883_pci_w32(rpc
, 0, RT3883_PCI_REG_PCIENA
);
225 irq_domain_add_linear(rpc
->intc_of_node
, RT3883_PCI_IRQ_COUNT
,
226 &rt3883_pci_irq_domain_ops
,
228 if (!rpc
->irq_domain
) {
229 dev_err(dev
, "unable to add IRQ domain\n");
233 irq_set_handler_data(irq
, rpc
);
234 irq_set_chained_handler(irq
, rt3883_pci_irq_handler
);
239 static int rt3883_pci_config_read(struct pci_bus
*bus
, unsigned int devfn
,
240 int where
, int size
, u32
*val
)
242 struct rt3883_pci_controller
*rpc
;
247 rpc
= pci_bus_to_rt3883_controller(bus
);
249 if (!rpc
->pcie_ready
&& bus
->number
== 1)
250 return PCIBIOS_DEVICE_NOT_FOUND
;
252 address
= rt3883_pci_get_cfgaddr(bus
->number
, PCI_SLOT(devfn
),
253 PCI_FUNC(devfn
), where
);
255 spin_lock_irqsave(&rpc
->lock
, flags
);
256 rt3883_pci_w32(rpc
, address
, RT3883_PCI_REG_CFGADDR
);
257 data
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_CFGDATA
);
258 spin_unlock_irqrestore(&rpc
->lock
, flags
);
262 *val
= (data
>> ((where
& 3) << 3)) & 0xff;
265 *val
= (data
>> ((where
& 3) << 3)) & 0xffff;
272 return PCIBIOS_SUCCESSFUL
;
275 static int rt3883_pci_config_write(struct pci_bus
*bus
, unsigned int devfn
,
276 int where
, int size
, u32 val
)
278 struct rt3883_pci_controller
*rpc
;
283 rpc
= pci_bus_to_rt3883_controller(bus
);
285 if (!rpc
->pcie_ready
&& bus
->number
== 1)
286 return PCIBIOS_DEVICE_NOT_FOUND
;
288 address
= rt3883_pci_get_cfgaddr(bus
->number
, PCI_SLOT(devfn
),
289 PCI_FUNC(devfn
), where
);
291 spin_lock_irqsave(&rpc
->lock
, flags
);
292 rt3883_pci_w32(rpc
, address
, RT3883_PCI_REG_CFGADDR
);
293 data
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_CFGDATA
);
297 data
= (data
& ~(0xff << ((where
& 3) << 3))) |
298 (val
<< ((where
& 3) << 3));
301 data
= (data
& ~(0xffff << ((where
& 3) << 3))) |
302 (val
<< ((where
& 3) << 3));
309 rt3883_pci_w32(rpc
, data
, RT3883_PCI_REG_CFGDATA
);
310 spin_unlock_irqrestore(&rpc
->lock
, flags
);
312 return PCIBIOS_SUCCESSFUL
;
315 static struct pci_ops rt3883_pci_ops
= {
316 .read
= rt3883_pci_config_read
,
317 .write
= rt3883_pci_config_write
,
320 static void rt3883_pci_preinit(struct rt3883_pci_controller
*rpc
, unsigned mode
)
327 rstctrl
= rt_sysc_r32(RT3883_SYSC_REG_RSTCTRL
);
328 syscfg1
= rt_sysc_r32(RT3883_SYSC_REG_SYSCFG1
);
329 clkcfg1
= rt_sysc_r32(RT3883_SYSC_REG_CLKCFG1
);
331 if (mode
& RT3883_PCI_MODE_PCIE
) {
332 rstctrl
|= RT3883_RSTCTRL_PCIE
;
333 rt_sysc_w32(rstctrl
, RT3883_SYSC_REG_RSTCTRL
);
335 /* setup PCI PAD drive mode */
338 rt_sysc_w32(syscfg1
, RT3883_SYSC_REG_SYSCFG1
);
340 t
= rt_sysc_r32(RT3883_SYSC_REG_PCIE_CLK_GEN0
);
342 rt_sysc_w32(t
, RT3883_SYSC_REG_PCIE_CLK_GEN0
);
344 t
= rt_sysc_r32(RT3883_SYSC_REG_PCIE_CLK_GEN1
);
346 rt_sysc_w32(t
, RT3883_SYSC_REG_PCIE_CLK_GEN1
);
348 t
= rt_sysc_r32(RT3883_SYSC_REG_PCIE_CLK_GEN1
);
350 rt_sysc_w32(t
, RT3883_SYSC_REG_PCIE_CLK_GEN1
);
352 t
= rt_sysc_r32(RT3883_SYSC_REG_PCIE_CLK_GEN0
);
354 rt_sysc_w32(t
, RT3883_SYSC_REG_PCIE_CLK_GEN0
);
358 rstctrl
&= ~RT3883_RSTCTRL_PCIE
;
359 rt_sysc_w32(rstctrl
, RT3883_SYSC_REG_RSTCTRL
);
362 syscfg1
|= (RT3883_SYSCFG1_PCIE_RC_MODE
| RT3883_SYSCFG1_PCI_HOST_MODE
);
364 clkcfg1
&= ~(RT3883_CLKCFG1_PCI_CLK_EN
| RT3883_CLKCFG1_PCIE_CLK_EN
);
366 if (mode
& RT3883_PCI_MODE_PCI
) {
367 clkcfg1
|= RT3883_CLKCFG1_PCI_CLK_EN
;
368 rstctrl
&= ~RT3883_RSTCTRL_PCI
;
371 if (mode
& RT3883_PCI_MODE_PCIE
) {
372 clkcfg1
|= RT3883_CLKCFG1_PCIE_CLK_EN
;
373 rstctrl
&= ~RT3883_RSTCTRL_PCIE
;
376 rt_sysc_w32(syscfg1
, RT3883_SYSC_REG_SYSCFG1
);
377 rt_sysc_w32(rstctrl
, RT3883_SYSC_REG_RSTCTRL
);
378 rt_sysc_w32(clkcfg1
, RT3883_SYSC_REG_CLKCFG1
);
383 * setup the device number of the P2P bridge
384 * and de-assert the reset line
386 t
= (RT3883_P2P_BR_DEVNUM
<< RT3883_PCICFG_P2P_BR_DEVNUM_S
);
387 rt3883_pci_w32(rpc
, t
, RT3883_PCI_REG_PCICFG
);
390 rt3883_pci_r32(rpc
, RT3883_PCI_REG_PCICFG
);
393 if (mode
& RT3883_PCI_MODE_PCIE
) {
396 t
= rt3883_pci_r32(rpc
, RT3883_PCI_REG_STATUS(1));
398 rpc
->pcie_ready
= t
& BIT(0);
400 if (!rpc
->pcie_ready
) {
401 /* reset the PCIe block */
402 t
= rt_sysc_r32(RT3883_SYSC_REG_RSTCTRL
);
403 t
|= RT3883_RSTCTRL_PCIE
;
404 rt_sysc_w32(t
, RT3883_SYSC_REG_RSTCTRL
);
405 t
&= ~RT3883_RSTCTRL_PCIE
;
406 rt_sysc_w32(t
, RT3883_SYSC_REG_RSTCTRL
);
408 /* turn off PCIe clock */
409 t
= rt_sysc_r32(RT3883_SYSC_REG_CLKCFG1
);
410 t
&= ~RT3883_CLKCFG1_PCIE_CLK_EN
;
411 rt_sysc_w32(t
, RT3883_SYSC_REG_CLKCFG1
);
413 t
= rt_sysc_r32(RT3883_SYSC_REG_PCIE_CLK_GEN0
);
415 rt_sysc_w32(t
, RT3883_SYSC_REG_PCIE_CLK_GEN0
);
419 /* enable PCI arbiter */
420 rt3883_pci_w32(rpc
, 0x79, RT3883_PCI_REG_ARBCTL
);
423 static int rt3883_pci_probe(struct platform_device
*pdev
)
425 struct rt3883_pci_controller
*rpc
;
426 struct device
*dev
= &pdev
->dev
;
427 struct device_node
*np
= dev
->of_node
;
428 struct resource
*res
;
429 struct device_node
*child
;
434 rpc
= devm_kzalloc(dev
, sizeof(*rpc
), GFP_KERNEL
);
438 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
439 rpc
->base
= devm_ioremap_resource(dev
, res
);
440 if (IS_ERR(rpc
->base
))
441 return PTR_ERR(rpc
->base
);
443 /* find the interrupt controller child node */
444 for_each_child_of_node(np
, child
) {
445 if (of_get_property(child
, "interrupt-controller", NULL
) &&
446 of_node_get(child
)) {
447 rpc
->intc_of_node
= child
;
452 if (!rpc
->intc_of_node
) {
453 dev_err(dev
, "%s has no %s child node",
454 of_node_full_name(rpc
->intc_of_node
),
455 "interrupt controller");
459 /* find the PCI host bridge child node */
460 for_each_child_of_node(np
, child
) {
462 of_node_cmp(child
->type
, "pci") == 0 &&
463 of_node_get(child
)) {
464 rpc
->pci_controller
.of_node
= child
;
469 if (!rpc
->pci_controller
.of_node
) {
470 dev_err(dev
, "%s has no %s child node",
471 of_node_full_name(rpc
->intc_of_node
),
474 goto err_put_intc_node
;
477 mode
= RT3883_PCI_MODE_NONE
;
478 for_each_available_child_of_node(rpc
->pci_controller
.of_node
, child
) {
482 of_node_cmp(child
->type
, "pci") != 0)
485 devfn
= of_pci_get_devfn(child
);
489 switch (PCI_SLOT(devfn
)) {
491 mode
|= RT3883_PCI_MODE_PCIE
;
496 mode
|= RT3883_PCI_MODE_PCI
;
501 if (mode
== RT3883_PCI_MODE_NONE
) {
502 dev_err(dev
, "unable to determine PCI mode\n");
504 goto err_put_hb_node
;
507 dev_info(dev
, "mode:%s%s\n",
508 (mode
& RT3883_PCI_MODE_PCI
) ? " PCI" : "",
509 (mode
& RT3883_PCI_MODE_PCIE
) ? " PCIe" : "");
511 rt3883_pci_preinit(rpc
, mode
);
513 rpc
->pci_controller
.pci_ops
= &rt3883_pci_ops
;
514 rpc
->pci_controller
.io_resource
= &rpc
->io_res
;
515 rpc
->pci_controller
.mem_resource
= &rpc
->mem_res
;
517 /* Load PCI I/O and memory resources from DT */
518 pci_load_of_ranges(&rpc
->pci_controller
,
519 rpc
->pci_controller
.of_node
);
521 rt3883_pci_w32(rpc
, rpc
->mem_res
.start
, RT3883_PCI_REG_MEMBASE
);
522 rt3883_pci_w32(rpc
, rpc
->io_res
.start
, RT3883_PCI_REG_IOBASE
);
524 ioport_resource
.start
= rpc
->io_res
.start
;
525 ioport_resource
.end
= rpc
->io_res
.end
;
528 rt3883_pci_w32(rpc
, 0x03ff0000, RT3883_PCI_REG_BAR0SETUP(0));
529 rt3883_pci_w32(rpc
, RT3883_MEMORY_BASE
, RT3883_PCI_REG_IMBASEBAR0(0));
530 rt3883_pci_w32(rpc
, 0x08021814, RT3883_PCI_REG_ID(0));
531 rt3883_pci_w32(rpc
, 0x00800001, RT3883_PCI_REG_CLASS(0));
532 rt3883_pci_w32(rpc
, 0x28801814, RT3883_PCI_REG_SUBID(0));
535 rt3883_pci_w32(rpc
, 0x03ff0000, RT3883_PCI_REG_BAR0SETUP(1));
536 rt3883_pci_w32(rpc
, RT3883_MEMORY_BASE
, RT3883_PCI_REG_IMBASEBAR0(1));
537 rt3883_pci_w32(rpc
, 0x08021814, RT3883_PCI_REG_ID(1));
538 rt3883_pci_w32(rpc
, 0x06040001, RT3883_PCI_REG_CLASS(1));
539 rt3883_pci_w32(rpc
, 0x28801814, RT3883_PCI_REG_SUBID(1));
541 err
= rt3883_pci_irq_init(dev
, rpc
);
543 goto err_put_hb_node
;
546 val
= rt3883_pci_read_cfg32(rpc
, 0, 0x01, 0, PCI_COMMAND
);
547 val
|= PCI_COMMAND_IO
| PCI_COMMAND_MEMORY
| PCI_COMMAND_MASTER
;
548 rt3883_pci_write_cfg32(rpc
, 0, 0x01, 0, PCI_COMMAND
, val
);
551 val
= rt3883_pci_read_cfg32(rpc
, 0, 0x00, 0, PCI_COMMAND
);
552 val
|= PCI_COMMAND_IO
| PCI_COMMAND_MEMORY
| PCI_COMMAND_MASTER
;
553 rt3883_pci_write_cfg32(rpc
, 0, 0x00, 0, PCI_COMMAND
, val
);
555 if (mode
== RT3883_PCI_MODE_PCIE
) {
556 rt3883_pci_w32(rpc
, 0x03ff0001, RT3883_PCI_REG_BAR0SETUP(0));
557 rt3883_pci_w32(rpc
, 0x03ff0001, RT3883_PCI_REG_BAR0SETUP(1));
559 rt3883_pci_write_cfg32(rpc
, 0, RT3883_P2P_BR_DEVNUM
, 0,
563 rt3883_pci_read_cfg32(rpc
, 0, RT3883_P2P_BR_DEVNUM
, 0,
566 rt3883_pci_write_cfg32(rpc
, 0, RT3883_P2P_BR_DEVNUM
, 0,
567 PCI_IO_BASE
, 0x00000101);
570 register_pci_controller(&rpc
->pci_controller
);
575 of_node_put(rpc
->pci_controller
.of_node
);
577 of_node_put(rpc
->intc_of_node
);
581 int __init
pcibios_map_irq(const struct pci_dev
*dev
, u8 slot
, u8 pin
)
583 return of_irq_parse_and_map_pci(dev
, slot
, pin
);
586 int pcibios_plat_dev_init(struct pci_dev
*dev
)
591 static const struct of_device_id rt3883_pci_ids
[] = {
592 { .compatible
= "ralink,rt3883-pci" },
595 MODULE_DEVICE_TABLE(of
, rt3883_pci_ids
);
597 static struct platform_driver rt3883_pci_driver
= {
598 .probe
= rt3883_pci_probe
,
600 .name
= "rt3883-pci",
601 .owner
= THIS_MODULE
,
602 .of_match_table
= of_match_ptr(rt3883_pci_ids
),
606 static int __init
rt3883_pci_init(void)
608 return platform_driver_register(&rt3883_pci_driver
);
611 postcore_initcall(rt3883_pci_init
);