1 From cc2cda651fcbc498bf513a6b802dca19944bcb37 Mon Sep 17 00:00:00 2001
2 From: Hauke Mehrtens <hauke@hauke-m.de>
3 Date: Mon, 12 May 2014 11:55:20 +0200
4 Subject: [PATCH 13/17] pcie2-bcma: add new PCIe2 driver for bcma
6 This driver supports the PCIe controller found on the BCM4708 and
7 similar SoCs. The controller itself is automatically detected by bcma.
9 Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de>
11 arch/arm/mach-bcm/Kconfig | 2 +
12 drivers/pci/host/Kconfig | 7 +
13 drivers/pci/host/Makefile | 1 +
14 drivers/pci/host/pcie2-bcma.c | 591 ++++++++++++++++++++++++++++++++++++++++++
15 4 files changed, 601 insertions(+)
16 create mode 100644 drivers/pci/host/pcie2-bcma.c
18 --- a/arch/arm/mach-bcm/Kconfig
19 +++ b/arch/arm/mach-bcm/Kconfig
20 @@ -46,6 +46,7 @@ config ARCH_BCM_5301X
21 select ARM_GLOBAL_TIMER
22 select CLKSRC_ARM_GLOBAL_TIMER_SCHED_CLOCK
24 + select PCI_DOMAINS if PCI
26 Support for Broadcom BCM470X and BCM5301X SoCs with ARM CPU cores.
28 --- a/drivers/pci/host/Kconfig
29 +++ b/drivers/pci/host/Kconfig
30 @@ -33,4 +33,11 @@ config PCI_RCAR_GEN2
31 There are 3 internal PCI controllers available with a single
32 built-in EHCI/OHCI host controller present on each one.
35 + bool "BCMA PCIe2 host controller"
36 + depends on BCMA && OF
38 + Say Y here if you want to support a simple generic PCI host
39 + controller, such as the one emulated by kvmtool.
42 --- a/drivers/pci/host/Makefile
43 +++ b/drivers/pci/host/Makefile
44 @@ -4,3 +4,4 @@ obj-$(CONFIG_PCI_IMX6) += pci-imx6.o
45 obj-$(CONFIG_PCI_MVEBU) += pci-mvebu.o
46 obj-$(CONFIG_PCI_TEGRA) += pci-tegra.o
47 obj-$(CONFIG_PCI_RCAR_GEN2) += pci-rcar-gen2.o
48 +obj-$(CONFIG_PCI_BCMA) += pcie2-bcma.o
50 +++ b/drivers/pci/host/pcie2-bcma.c
53 + * Northstar PCI-Express driver
54 + * Only supports Root-Complex (RC) mode
57 + * PCI Domains are being used to identify the PCIe port 1:1.
59 + * Only MEM access is supported, PAX does not support IO.
63 + * DRAM > 128 MBytes (e.g. DMA zones)
66 +#include <linux/kernel.h>
67 +#include <linux/module.h>
68 +#include <linux/bug.h>
69 +#include <linux/delay.h>
70 +#include <linux/pci.h>
71 +#include <linux/io.h>
72 +#include <linux/ioport.h>
73 +#include <linux/interrupt.h>
74 +#include <linux/bcma/bcma.h>
76 +#define SI_ENUM_BASE 0x18000000 /* Enumeration space base */
79 + * Register offset definitions
81 +#define SOC_PCIE_CONTROL 0x000 /* a.k.a. CLK_CONTROL reg */
82 +#define SOC_PCIE_PM_STATUS 0x008
83 +#define SOC_PCIE_PM_CONTROL 0x00c /* in EP mode only ! */
85 +#define SOC_PCIE_EXT_CFG_ADDR 0x120
86 +#define SOC_PCIE_EXT_CFG_DATA 0x124
87 +#define SOC_PCIE_CFG_ADDR 0x1f8
88 +#define SOC_PCIE_CFG_DATA 0x1fc
90 +#define SOC_PCIE_SYS_RC_INTX_EN 0x330
91 +#define SOC_PCIE_SYS_RC_INTX_CSR 0x334
92 +#define SOC_PCIE_SYS_HOST_INTR_EN 0x344
93 +#define SOC_PCIE_SYS_HOST_INTR_CSR 0x348
95 +#define SOC_PCIE_HDR_OFF 0x400 /* 256 bytes per function */
97 +/* 32-bit 4KB in-bound mapping windows for Function 0..3, n=0..7 */
98 +#define SOC_PCIE_SYS_IMAP0(f, n) (0xc00 + ((f) << 9)((n) << 2))
99 +/* 64-bit in-bound mapping windows for func 0..3 */
100 +#define SOC_PCIE_SYS_IMAP1(f) (0xc80 + ((f) << 3))
101 +#define SOC_PCIE_SYS_IMAP2(f) (0xcc0 + ((f) << 3))
102 +/* 64-bit in-bound address range n=0..2 */
103 +#define SOC_PCIE_SYS_IARR(n) (0xd00 + ((n) << 3))
104 +/* 64-bit out-bound address filter n=0..2 */
105 +#define SOC_PCIE_SYS_OARR(n) (0xd20 + ((n) << 3))
106 +/* 64-bit out-bound mapping windows n=0..2 */
107 +#define SOC_PCIE_SYS_OMAP(n) (0xd40 + ((n) << 3))
109 +#define BCM4360_D11AC_ID 0x43a0
110 +#define BCM4360_D11AC2G_ID 0x43a1
111 +#define BCM4360_D11AC5G_ID 0x43a2
112 +#define BCM4352_D11AC_ID 0x43b1 /* 4352 802.11ac dualband device */
113 +#define BCM4352_D11AC2G_ID 0x43b2 /* 4352 802.11ac 2.4G device */
114 +#define BCM4352_D11AC5G_ID 0x43b3 /* 4352 802.11ac 5G device */
116 +static int bcma_pcie2_map_irq(const struct pci_dev *pdev, u8 slot, u8 pin)
118 + struct pci_sys_data *sys = pdev->sysdata;
119 + struct bcma_device *bdev = sys->private_data;
124 +static u32 bcma_pcie2_cfg_base(struct bcma_device *bdev, int busno,
125 + unsigned int devfn, int where)
127 + int slot = PCI_SLOT(devfn);
128 + int fn = PCI_FUNC(devfn);
134 + bcma_write32(bdev, SOC_PCIE_EXT_CFG_ADDR, where & 0xffc);
135 + return SOC_PCIE_EXT_CFG_DATA;
139 + addr_reg = (busno & 0xff) << 20 | (slot << 15) | (fn << 12) |
140 + (where & 0xffc) | (1 & 0x3);
142 + bcma_write32(bdev, SOC_PCIE_CFG_ADDR, addr_reg);
143 + return SOC_PCIE_CFG_DATA;
146 +static u32 bcma_pcie2_read_config(struct bcma_device *bdev, int busno,
147 + unsigned int devfn, int where, int size)
154 + base = bcma_pcie2_cfg_base(bdev, busno, devfn, where);
159 + data_reg = bcma_read32(bdev, base);
161 + /* NS: CLASS field is R/O, and set to wrong 0x200 value */
162 + if (busno == 0 && devfn == 0) {
164 + * RC's class is 0x0280, but Linux PCI driver needs 0x604
165 + * for a PCIe bridge. So we must fixup the class code
168 + if ((where & 0xffc) == PCI_CLASS_REVISION) {
170 + data_reg |= 0x604 << 16;
173 + /* HEADER_TYPE=00 indicates the port in EP mode */
178 + mask = (1 << (size * 8)) - 1;
179 + shift = (where % 4) * 8;
180 + return (data_reg >> shift) & mask;
183 +static void bcma_pcie2_write_config(struct bcma_device *bdev, int busno,
184 + unsigned int devfn, int where, int size,
190 + base = bcma_pcie2_cfg_base(bdev, busno, devfn, where);
196 + u32 mask = (1 << (size * 8)) - 1;
197 + int shift = (where % 4) * 8;
199 + data_reg = bcma_read32(bdev, base);
200 + data_reg &= ~(mask << shift);
201 + data_reg |= (val & mask) << shift;
206 + bcma_write32(bdev, base, data_reg);
209 +static u8 bcma_pcie2_read_config8(struct bcma_device *bdev, int busno,
210 + unsigned int devfn, int where)
212 + return bcma_pcie2_read_config(bdev, busno, devfn, where, 1);
215 +static u16 bcma_pcie2_read_config16(struct bcma_device *bdev, int busno,
216 + unsigned int devfn, int where)
218 + return bcma_pcie2_read_config(bdev, busno, devfn, where, 2);
221 +static u32 bcma_pcie2_read_config32(struct bcma_device *bdev, int busno,
222 + unsigned int devfn, int where)
224 + return bcma_pcie2_read_config(bdev, busno, devfn, where, 4);
227 +static void bcma_pcie2_write_config8(struct bcma_device *bdev, int busno,
228 + unsigned int devfn, int where, u8 val)
230 + return bcma_pcie2_write_config(bdev, busno, devfn, where, 1, val);
233 +static void bcma_pcie2_write_config16(struct bcma_device *bdev, int busno,
234 + unsigned int devfn, int where, u16 val)
236 + return bcma_pcie2_write_config(bdev, busno, devfn, where, 2, val);
239 +static void bcma_pcie2_write_config32(struct bcma_device *bdev, int busno,
240 + unsigned int devfn, int where, u32 val)
242 + return bcma_pcie2_write_config(bdev, busno, devfn, where, 4, val);
245 +static int bcma_pcie2_read_config_pci(struct pci_bus *bus, unsigned int devfn,
246 + int where, int size, u32 *val)
248 + struct pci_sys_data *sys = bus->sysdata;
249 + struct bcma_device *bdev = sys->private_data;
251 + *val = bcma_pcie2_read_config(bdev, bus->number, devfn, where, size);
253 + return PCIBIOS_SUCCESSFUL;
256 +static int bcma_pcie2_write_config_pci(struct pci_bus *bus, unsigned int devfn,
257 + int where, int size, u32 val)
259 + struct pci_sys_data *sys = bus->sysdata;
260 + struct bcma_device *bdev = sys->private_data;
262 + bcma_pcie2_write_config(bdev, bus->number, devfn, where, size, val);
264 + return PCIBIOS_SUCCESSFUL;
268 + * Check link status, return 0 if link is up in RC mode,
269 + * otherwise return non-zero
271 +static int bcma_pcie2_check_link(struct bcma_device *bdev, u32 allow_gen2)
277 + tmp32 = bcma_pcie2_read_config32(bdev, 0, devfn, 0xdc);
282 + /* force PCIE GEN1 */
285 + bcma_pcie2_write_config32(bdev, 0, devfn, 0xdc, tmp32);
287 + /* See if the port is in EP mode, indicated by header type 00 */
288 + tmp8 = bcma_pcie2_read_config8(bdev, 0, devfn, PCI_HEADER_TYPE);
289 + if (tmp8 != PCI_HEADER_TYPE_BRIDGE) {
290 + dev_info(&bdev->dev, "Port %d in End-Point mode - ignored\n",
299 + * Initializte the PCIe controller
301 +static void bcma_pcie2_hw_init(struct bcma_device *bdev)
307 + /* Change MPS and MRRS to 512 */
308 + tmp16 = bcma_pcie2_read_config16(bdev, 0, devfn, 0x4d4);
311 + bcma_pcie2_write_config16(bdev, 0, devfn, 0x4d4, tmp16);
313 + tmp32 = bcma_pcie2_read_config32(bdev, 0, devfn, 0xb4);
314 + tmp32 &= ~((7 << 12) | (7 << 5));
315 + tmp32 |= (2 << 12) | (2 << 5);
316 + bcma_pcie2_write_config32(bdev, 0, devfn, 0xb4, tmp32);
318 + /* Turn-on Root-Complex (RC) mode, from reset defailt of EP */
320 + /* The mode is set by straps, can be overwritten via DMU
321 + register <cru_straps_control> bit 5, "1" means RC
324 + /* Send a downstream reset */
325 + bcma_write32(bdev, SOC_PCIE_CONTROL, 0x3);
327 + bcma_write32(bdev, SOC_PCIE_CONTROL, 0x1);
330 + /* TBD: take care of PM, check we're on */
334 + * Setup the address translation
336 +static void bcma_pcie2_map_init(struct bcma_device *bdev)
343 + * All PCI-to-CPU address mapping are 1:1 for simplicity
346 + /* Outbound address translation setup */
348 + addr = bdev->addr_s[0];
350 + BUG_ON(addr & ((1 << 25) - 1)); /* 64MB alignment */
352 + for (i = 0; i < 3; i++) {
353 + const unsigned win_size = SZ_64M;
354 + /* 64-bit LE regs, write low word, high is 0 at reset */
355 + bcma_write32(bdev, SOC_PCIE_SYS_OMAP(i), addr);
356 + bcma_write32(bdev, SOC_PCIE_SYS_OARR(i), addr|0x1);
358 + if (size >= win_size)
366 + * Inbound address translation setup
367 + * Northstar only maps up to 128 MiB inbound, DRAM could be up to 1 GiB.
369 + * For now allow access to entire DRAM, assuming it is less than 128MiB,
370 + * otherwise DMA bouncing mechanism may be required.
371 + * Also consider DMA mask to limit DMA physical address
374 + addr = PHYS_OFFSET;
376 + size >>= 20; /* In MB */
377 + size &= 0xff; /* Size is an 8-bit field */
379 + WARN_ON(size == 0);
380 + /* 64-bit LE regs, write low word, high is 0 at reset */
381 + bcma_write32(bdev, SOC_PCIE_SYS_IMAP1(0), addr | 0x1);
382 + bcma_write32(bdev, SOC_PCIE_SYS_IARR(1), addr | size);
384 +#ifdef CONFIG_SPARSEMEM
385 + addr = PHYS_OFFSET2;
386 + bcma_write32(bdev, SOC_PCIE_SYS_IMAP2(0), addr | 0x1);
387 + bcma_write32(bdev, SOC_PCIE_SYS_IARR(2), addr | size);
392 + * Setup PCIE Host bridge
394 +static void bcma_pcie2_bridge_init(struct bcma_device *bdev)
400 + bcma_pcie2_write_config8(bdev, 0, devfn, PCI_PRIMARY_BUS, 0);
401 + bcma_pcie2_write_config8(bdev, 0, devfn, PCI_SECONDARY_BUS, 1);
402 + bcma_pcie2_write_config8(bdev, 0, devfn, PCI_SUBORDINATE_BUS, 4);
404 + tmp8 = bcma_pcie2_read_config8(bdev, 0, devfn, PCI_PRIMARY_BUS);
405 + tmp8 = bcma_pcie2_read_config8(bdev, 0, devfn, PCI_SECONDARY_BUS);
406 + tmp8 = bcma_pcie2_read_config8(bdev, 0, devfn, PCI_SUBORDINATE_BUS);
408 + /* MEM_BASE, MEM_LIM require 1MB alignment */
409 + BUG_ON((bdev->addr_s[0] >> 16) & 0xf);
410 + bcma_pcie2_write_config16(bdev, 0, devfn, PCI_MEMORY_BASE,
411 + bdev->addr_s[0] >> 16);
412 + BUG_ON(((bdev->addr_s[0] + SZ_128M) >> 16) & 0xf);
413 + bcma_pcie2_write_config16(bdev, 0, devfn, PCI_MEMORY_LIMIT,
414 + (bdev->addr_s[0] + SZ_128M) >> 16);
416 + /* These registers are not supported on the NS */
417 + bcma_pcie2_write_config16(bdev, 0, devfn, PCI_IO_BASE_UPPER16, 0);
418 + bcma_pcie2_write_config16(bdev, 0, devfn, PCI_IO_LIMIT_UPPER16, 0);
420 + /* Force class to that of a Bridge */
421 + bcma_pcie2_write_config16(bdev, 0, devfn, PCI_CLASS_DEVICE,
422 + PCI_CLASS_BRIDGE_PCI);
424 + tmp16 = bcma_pcie2_read_config16(bdev, 0, devfn, PCI_CLASS_DEVICE);
425 + tmp16 = bcma_pcie2_read_config16(bdev, 0, devfn, PCI_MEMORY_BASE);
426 + tmp16 = bcma_pcie2_read_config16(bdev, 0, devfn, PCI_MEMORY_LIMIT);
429 +static int bcma_pcie2_allow_gen2_rc(struct bcma_device *bdev)
431 + u32 vendorid, devid, chipid, chiprev;
433 + void __iomem *base;
436 + /* Read PCI vendor/device ID's */
437 + bcma_write32(bdev, SOC_PCIE_CFG_ADDR, 0x0);
438 + val = bcma_read32(bdev, SOC_PCIE_CFG_DATA);
439 + vendorid = val & 0xffff;
441 + if (vendorid == PCI_VENDOR_ID_BROADCOM &&
442 + (devid == BCMA_CHIP_ID_BCM4360 || devid == BCM4360_D11AC_ID ||
443 + devid == BCM4360_D11AC2G_ID || devid == BCM4360_D11AC5G_ID ||
444 + devid == BCM4352_D11AC_ID || devid == BCM4352_D11AC2G_ID ||
445 + devid == BCM4352_D11AC5G_ID)) {
447 + bar = bdev->addr_s[0];
448 + bcma_write32(bdev, SOC_PCIE_CFG_ADDR, 0x10);
449 + bcma_write32(bdev, SOC_PCIE_CFG_DATA, bar);
450 + /* Config BAR0 window to access chipc */
451 + bcma_write32(bdev, SOC_PCIE_CFG_ADDR, 0x80);
452 + bcma_write32(bdev, SOC_PCIE_CFG_DATA, SI_ENUM_BASE);
454 + /* Enable memory resource */
455 + bcma_write32(bdev, SOC_PCIE_CFG_ADDR, 0x4);
456 + val = bcma_read32(bdev, SOC_PCIE_CFG_DATA);
457 + val |= PCI_COMMAND_MEMORY;
458 + bcma_write32(bdev, SOC_PCIE_CFG_DATA, val);
459 + /* Enable memory and bus master */
460 + bcma_write32(bdev, SOC_PCIE_HDR_OFF + 4, 0x6);
463 + base = ioremap(bar, 0x1000);
464 + val = __raw_readl(base);
466 + chipid = val & 0xffff;
467 + chiprev = (val >> 16) & 0xf;
468 + if ((chipid == BCMA_CHIP_ID_BCM4360 ||
469 + chipid == BCMA_CHIP_ID_BCM43460 ||
470 + chipid == BCMA_CHIP_ID_BCM4352) && (chiprev < 3))
476 +static void bcma_pcie2_3rd_init(struct bcma_bus *bus)
478 + /* PCIE PLL block register (base 0x8000) */
479 + bcma_chipco_b_mii_write(&bus->drv_cc_b, 0x00000088, 0x57fe8000);
480 + /* Check PCIE PLL lock status */
481 + bcma_chipco_b_mii_write(&bus->drv_cc_b, 0x00000088, 0x67c60000);
484 +/* To improve PCIE phy jitter */
485 +static void bcma_pcie2_improve_phy_jitter(struct bcma_bus *bus, int phyaddr)
489 + /* Change blkaddr */
490 + val = (1 << 30) | (1 << 28) | (phyaddr << 23) | (0x1f << 18) |
491 + (2 << 16) | (0x863 << 4);
492 + bcma_chipco_b_mii_write(&bus->drv_cc_b, 0x0000009a, val);
494 + /* Write 0x0190 to 0x13 regaddr */
495 + val = (1 << 30) | (1 << 28) | (phyaddr << 23) | (0x13 << 18) |
496 + (2 << 16) | 0x0190;
497 + bcma_chipco_b_mii_write(&bus->drv_cc_b, 0x0000009a, val);
499 + /* Write 0x0191 to 0x19 regaddr */
500 + val = (1 << 30) | (1 << 28) | (phyaddr << 23) | (0x19 << 18) |
501 + (2 << 16) | 0x0191;
502 + bcma_chipco_b_mii_write(&bus->drv_cc_b, 0x0000009a, val);
505 +static int bcma_pcie2_setup(int nr, struct pci_sys_data *sys)
507 + struct bcma_device *bdev = sys->private_data;
508 + struct bcma_bus *bus = bdev->bus;
509 + struct resource *res;
510 + struct bcma_device *arm_core;
511 + u32 cru_straps_ctrl;
512 + int allow_gen2, linkfail;
515 + if (bdev->core_unit == 2) {
516 + arm_core = bcma_find_core(bus, BCMA_CORE_ARMCA9);
517 + cru_straps_ctrl = bcma_read32(arm_core, 0x2a0);
519 + /* 3rd PCIE is not selected */
520 + if (cru_straps_ctrl & 0x10)
523 + bcma_pcie2_3rd_init(bus);
526 + phyaddr = bdev->core_unit;
528 + bcma_pcie2_improve_phy_jitter(bus, phyaddr);
530 + /* create mem resource */
531 + res = devm_kzalloc(&bdev->dev, sizeof(*res), GFP_KERNEL);
535 + res->start = bdev->addr_s[0];
536 + res->end = res->start + SZ_128M - 1;
537 + res->name = "PCIe Configuration Space";
538 + res->flags = IORESOURCE_MEM;
540 + pci_add_resource(&sys->resources, res);
542 + /* This PCIe controller does not support IO Mem, so use a dummy one. */
543 + res = devm_kzalloc(&bdev->dev, sizeof(*res), GFP_KERNEL);
547 + res->start = bdev->addr_s[0];
548 + res->end = res->start + SZ_128M - 1;
549 + res->name = "PCIe Configuration Space";
550 + res->flags = IORESOURCE_IO;
552 + pci_add_resource(&sys->resources, res);
554 + for (allow_gen2 = 0; allow_gen2 <= 1; allow_gen2++) {
555 + bcma_pcie2_hw_init(bdev);
556 + bcma_pcie2_map_init(bdev);
559 + * Skip inactive ports -
560 + * will need to change this for hot-plugging
562 + linkfail = bcma_pcie2_check_link(bdev, allow_gen2);
566 + bcma_pcie2_bridge_init(bdev);
568 + if (allow_gen2 == 0) {
569 + if (bcma_pcie2_allow_gen2_rc(bdev) == 0)
571 + dev_info(&bdev->dev, "switching to GEN2\n");
582 + * Methods for accessing configuration registers
584 +static struct pci_ops bcma_pcie2_ops = {
585 + .read = bcma_pcie2_read_config_pci,
586 + .write = bcma_pcie2_write_config_pci,
589 +static int bcma_pcie2_probe(struct bcma_device *bdev)
593 + dev_info(&bdev->dev, "scanning bus\n");
595 + hw = (struct hw_pci) {
596 + .nr_controllers = 1,
597 + .domain = bdev->core_unit,
598 + .private_data = (void **)&bdev,
599 + .setup = bcma_pcie2_setup,
600 + .map_irq = bcma_pcie2_map_irq,
601 + .ops = &bcma_pcie2_ops,
604 + /* Announce this port to ARM/PCI common code */
605 + pci_common_init_dev(&bdev->dev, &hw);
607 + /* Setup virtual-wire interrupts */
608 + bcma_write32(bdev, SOC_PCIE_SYS_RC_INTX_EN, 0xf);
610 + /* Enable memory and bus master */
611 + bcma_write32(bdev, SOC_PCIE_HDR_OFF + 4, 0x6);
616 +static const struct bcma_device_id bcma_pcie2_table[] = {
617 + BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_NS_PCIEG2, BCMA_ANY_REV, BCMA_ANY_CLASS),
620 +MODULE_DEVICE_TABLE(bcma, bcma_pcie2_table);
622 +static struct bcma_driver bcma_pcie2_driver = {
623 + .name = KBUILD_MODNAME,
624 + .id_table = bcma_pcie2_table,
625 + .probe = bcma_pcie2_probe,
628 +static int __init bcma_pcie2_init(void)
630 + return bcma_driver_register(&bcma_pcie2_driver);
632 +module_init(bcma_pcie2_init);
634 +static void __exit bcma_pcie2_exit(void)
636 + bcma_driver_unregister(&bcma_pcie2_driver);
638 +module_exit(bcma_pcie2_exit);
640 +MODULE_AUTHOR("Hauke Mehrtens");
641 +MODULE_DESCRIPTION("PCIe Gen2 driver for BCMA");
642 +MODULE_LICENSE("GPLv2");