2011-05-09 16:56:46 +00:00
|
|
|
/*
|
|
|
|
* Broadcom specific AMBA
|
|
|
|
* PCI Host
|
|
|
|
*
|
|
|
|
* Licensed under the GNU/GPL. See COPYING for details.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "bcma_private.h"
|
2011-05-26 23:24:57 +00:00
|
|
|
#include <linux/slab.h>
|
2011-05-09 16:56:46 +00:00
|
|
|
#include <linux/bcma/bcma.h>
|
|
|
|
#include <linux/pci.h>
|
2011-07-01 20:06:37 +00:00
|
|
|
#include <linux/module.h>
|
2011-05-09 16:56:46 +00:00
|
|
|
|
|
|
|
static void bcma_host_pci_switch_core(struct bcma_device *core)
|
|
|
|
{
|
2015-01-25 12:41:19 +00:00
|
|
|
int win2 = core->bus->host_is_pcie2 ?
|
|
|
|
BCMA_PCIE2_BAR0_WIN2 : BCMA_PCI_BAR0_WIN2;
|
|
|
|
|
2011-05-09 16:56:46 +00:00
|
|
|
pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN,
|
|
|
|
core->addr);
|
2015-01-25 12:41:19 +00:00
|
|
|
pci_write_config_dword(core->bus->host_pci, win2, core->wrap);
|
2011-05-09 16:56:46 +00:00
|
|
|
core->bus->mapped_core = core;
|
2012-07-05 20:07:32 +00:00
|
|
|
bcma_debug(core->bus, "Switched to core: 0x%X\n", core->id.id);
|
2011-05-09 16:56:46 +00:00
|
|
|
}
|
|
|
|
|
2011-12-05 18:13:39 +00:00
|
|
|
/* Provides access to the requested core. Returns base offset that has to be
|
|
|
|
* used. It makes use of fixed windows when possible. */
|
|
|
|
static u16 bcma_host_pci_provide_access_to_core(struct bcma_device *core)
|
2011-05-09 16:56:46 +00:00
|
|
|
{
|
2011-12-05 18:13:39 +00:00
|
|
|
switch (core->id.id) {
|
|
|
|
case BCMA_CORE_CHIPCOMMON:
|
|
|
|
return 3 * BCMA_CORE_SIZE;
|
|
|
|
case BCMA_CORE_PCIE:
|
|
|
|
return 2 * BCMA_CORE_SIZE;
|
|
|
|
}
|
|
|
|
|
2011-05-09 16:56:46 +00:00
|
|
|
if (core->bus->mapped_core != core)
|
|
|
|
bcma_host_pci_switch_core(core);
|
2011-12-05 18:13:39 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static u8 bcma_host_pci_read8(struct bcma_device *core, u16 offset)
|
|
|
|
{
|
|
|
|
offset += bcma_host_pci_provide_access_to_core(core);
|
2011-05-09 16:56:46 +00:00
|
|
|
return ioread8(core->bus->mmio + offset);
|
|
|
|
}
|
|
|
|
|
|
|
|
static u16 bcma_host_pci_read16(struct bcma_device *core, u16 offset)
|
|
|
|
{
|
2011-12-05 18:13:39 +00:00
|
|
|
offset += bcma_host_pci_provide_access_to_core(core);
|
2011-05-09 16:56:46 +00:00
|
|
|
return ioread16(core->bus->mmio + offset);
|
|
|
|
}
|
|
|
|
|
|
|
|
static u32 bcma_host_pci_read32(struct bcma_device *core, u16 offset)
|
|
|
|
{
|
2011-12-05 18:13:39 +00:00
|
|
|
offset += bcma_host_pci_provide_access_to_core(core);
|
2011-05-09 16:56:46 +00:00
|
|
|
return ioread32(core->bus->mmio + offset);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void bcma_host_pci_write8(struct bcma_device *core, u16 offset,
|
|
|
|
u8 value)
|
|
|
|
{
|
2011-12-05 18:13:39 +00:00
|
|
|
offset += bcma_host_pci_provide_access_to_core(core);
|
2011-05-09 16:56:46 +00:00
|
|
|
iowrite8(value, core->bus->mmio + offset);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void bcma_host_pci_write16(struct bcma_device *core, u16 offset,
|
|
|
|
u16 value)
|
|
|
|
{
|
2011-12-05 18:13:39 +00:00
|
|
|
offset += bcma_host_pci_provide_access_to_core(core);
|
2011-05-09 16:56:46 +00:00
|
|
|
iowrite16(value, core->bus->mmio + offset);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void bcma_host_pci_write32(struct bcma_device *core, u16 offset,
|
|
|
|
u32 value)
|
|
|
|
{
|
2011-12-05 18:13:39 +00:00
|
|
|
offset += bcma_host_pci_provide_access_to_core(core);
|
2011-05-09 16:56:46 +00:00
|
|
|
iowrite32(value, core->bus->mmio + offset);
|
|
|
|
}
|
|
|
|
|
2011-05-20 01:27:06 +00:00
|
|
|
#ifdef CONFIG_BCMA_BLOCKIO
|
2012-08-05 14:54:41 +00:00
|
|
|
static void bcma_host_pci_block_read(struct bcma_device *core, void *buffer,
|
|
|
|
size_t count, u16 offset, u8 reg_width)
|
2011-05-20 01:27:06 +00:00
|
|
|
{
|
|
|
|
void __iomem *addr = core->bus->mmio + offset;
|
|
|
|
if (core->bus->mapped_core != core)
|
|
|
|
bcma_host_pci_switch_core(core);
|
|
|
|
switch (reg_width) {
|
|
|
|
case sizeof(u8):
|
|
|
|
ioread8_rep(addr, buffer, count);
|
|
|
|
break;
|
|
|
|
case sizeof(u16):
|
|
|
|
WARN_ON(count & 1);
|
|
|
|
ioread16_rep(addr, buffer, count >> 1);
|
|
|
|
break;
|
|
|
|
case sizeof(u32):
|
|
|
|
WARN_ON(count & 3);
|
|
|
|
ioread32_rep(addr, buffer, count >> 2);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
WARN_ON(1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-08-05 14:54:41 +00:00
|
|
|
static void bcma_host_pci_block_write(struct bcma_device *core,
|
|
|
|
const void *buffer, size_t count,
|
|
|
|
u16 offset, u8 reg_width)
|
2011-05-20 01:27:06 +00:00
|
|
|
{
|
|
|
|
void __iomem *addr = core->bus->mmio + offset;
|
|
|
|
if (core->bus->mapped_core != core)
|
|
|
|
bcma_host_pci_switch_core(core);
|
|
|
|
switch (reg_width) {
|
|
|
|
case sizeof(u8):
|
|
|
|
iowrite8_rep(addr, buffer, count);
|
|
|
|
break;
|
|
|
|
case sizeof(u16):
|
|
|
|
WARN_ON(count & 1);
|
|
|
|
iowrite16_rep(addr, buffer, count >> 1);
|
|
|
|
break;
|
|
|
|
case sizeof(u32):
|
|
|
|
WARN_ON(count & 3);
|
|
|
|
iowrite32_rep(addr, buffer, count >> 2);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
WARN_ON(1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2011-05-09 16:56:46 +00:00
|
|
|
static u32 bcma_host_pci_aread32(struct bcma_device *core, u16 offset)
|
|
|
|
{
|
|
|
|
if (core->bus->mapped_core != core)
|
|
|
|
bcma_host_pci_switch_core(core);
|
|
|
|
return ioread32(core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void bcma_host_pci_awrite32(struct bcma_device *core, u16 offset,
|
|
|
|
u32 value)
|
|
|
|
{
|
|
|
|
if (core->bus->mapped_core != core)
|
|
|
|
bcma_host_pci_switch_core(core);
|
|
|
|
iowrite32(value, core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
|
|
|
|
}
|
|
|
|
|
2012-08-05 14:54:41 +00:00
|
|
|
static const struct bcma_host_ops bcma_host_pci_ops = {
|
2011-05-09 16:56:46 +00:00
|
|
|
.read8 = bcma_host_pci_read8,
|
|
|
|
.read16 = bcma_host_pci_read16,
|
|
|
|
.read32 = bcma_host_pci_read32,
|
|
|
|
.write8 = bcma_host_pci_write8,
|
|
|
|
.write16 = bcma_host_pci_write16,
|
|
|
|
.write32 = bcma_host_pci_write32,
|
2011-05-20 01:27:06 +00:00
|
|
|
#ifdef CONFIG_BCMA_BLOCKIO
|
|
|
|
.block_read = bcma_host_pci_block_read,
|
|
|
|
.block_write = bcma_host_pci_block_write,
|
|
|
|
#endif
|
2011-05-09 16:56:46 +00:00
|
|
|
.aread32 = bcma_host_pci_aread32,
|
|
|
|
.awrite32 = bcma_host_pci_awrite32,
|
|
|
|
};
|
|
|
|
|
2012-12-21 23:12:59 +00:00
|
|
|
static int bcma_host_pci_probe(struct pci_dev *dev,
|
|
|
|
const struct pci_device_id *id)
|
2011-05-09 16:56:46 +00:00
|
|
|
{
|
|
|
|
struct bcma_bus *bus;
|
|
|
|
int err = -ENOMEM;
|
|
|
|
const char *name;
|
|
|
|
u32 val;
|
|
|
|
|
|
|
|
/* Alloc */
|
|
|
|
bus = kzalloc(sizeof(*bus), GFP_KERNEL);
|
|
|
|
if (!bus)
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
/* Basic PCI configuration */
|
|
|
|
err = pci_enable_device(dev);
|
|
|
|
if (err)
|
|
|
|
goto err_kfree_bus;
|
|
|
|
|
|
|
|
name = dev_name(&dev->dev);
|
|
|
|
if (dev->driver && dev->driver->name)
|
|
|
|
name = dev->driver->name;
|
|
|
|
err = pci_request_regions(dev, name);
|
|
|
|
if (err)
|
|
|
|
goto err_pci_disable;
|
|
|
|
pci_set_master(dev);
|
|
|
|
|
|
|
|
/* Disable the RETRY_TIMEOUT register (0x41) to keep
|
|
|
|
* PCI Tx retries from interfering with C3 CPU state */
|
|
|
|
pci_read_config_dword(dev, 0x40, &val);
|
|
|
|
if ((val & 0x0000ff00) != 0)
|
|
|
|
pci_write_config_dword(dev, 0x40, val & 0xffff00ff);
|
|
|
|
|
|
|
|
/* SSB needed additional powering up, do we have any AMBA PCI cards? */
|
2013-10-03 11:49:09 +00:00
|
|
|
if (!pci_is_pcie(dev)) {
|
|
|
|
bcma_err(bus, "PCI card detected, they are not supported.\n");
|
|
|
|
err = -ENXIO;
|
|
|
|
goto err_pci_release_regions;
|
|
|
|
}
|
2011-05-09 16:56:46 +00:00
|
|
|
|
|
|
|
/* Map MMIO */
|
|
|
|
err = -ENOMEM;
|
|
|
|
bus->mmio = pci_iomap(dev, 0, ~0UL);
|
|
|
|
if (!bus->mmio)
|
|
|
|
goto err_pci_release_regions;
|
|
|
|
|
|
|
|
/* Host specific */
|
|
|
|
bus->host_pci = dev;
|
|
|
|
bus->hosttype = BCMA_HOSTTYPE_PCI;
|
|
|
|
bus->ops = &bcma_host_pci_ops;
|
|
|
|
|
2012-04-29 00:04:08 +00:00
|
|
|
bus->boardinfo.vendor = bus->host_pci->subsystem_vendor;
|
|
|
|
bus->boardinfo.type = bus->host_pci->subsystem_device;
|
|
|
|
|
2014-09-01 21:11:06 +00:00
|
|
|
/* Initialize struct, detect chip */
|
|
|
|
bcma_init_bus(bus);
|
|
|
|
|
2011-05-09 16:56:46 +00:00
|
|
|
/* Register */
|
|
|
|
err = bcma_bus_register(bus);
|
|
|
|
if (err)
|
|
|
|
goto err_pci_unmap_mmio;
|
|
|
|
|
|
|
|
pci_set_drvdata(dev, bus);
|
|
|
|
|
|
|
|
out:
|
|
|
|
return err;
|
|
|
|
|
|
|
|
err_pci_unmap_mmio:
|
|
|
|
pci_iounmap(dev, bus->mmio);
|
|
|
|
err_pci_release_regions:
|
|
|
|
pci_release_regions(dev);
|
|
|
|
err_pci_disable:
|
|
|
|
pci_disable_device(dev);
|
|
|
|
err_kfree_bus:
|
|
|
|
kfree(bus);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2012-12-21 23:12:59 +00:00
|
|
|
static void bcma_host_pci_remove(struct pci_dev *dev)
|
2011-05-09 16:56:46 +00:00
|
|
|
{
|
|
|
|
struct bcma_bus *bus = pci_get_drvdata(dev);
|
|
|
|
|
|
|
|
bcma_bus_unregister(bus);
|
|
|
|
pci_iounmap(dev, bus->mmio);
|
|
|
|
pci_release_regions(dev);
|
|
|
|
pci_disable_device(dev);
|
|
|
|
kfree(bus);
|
|
|
|
}
|
|
|
|
|
2012-10-16 14:59:02 +00:00
|
|
|
#ifdef CONFIG_PM_SLEEP
|
2012-01-13 22:58:39 +00:00
|
|
|
static int bcma_host_pci_suspend(struct device *dev)
|
2011-12-09 21:16:07 +00:00
|
|
|
{
|
2012-01-13 22:58:39 +00:00
|
|
|
struct pci_dev *pdev = to_pci_dev(dev);
|
|
|
|
struct bcma_bus *bus = pci_get_drvdata(pdev);
|
2011-12-09 21:16:07 +00:00
|
|
|
|
2012-01-13 22:58:38 +00:00
|
|
|
bus->mapped_core = NULL;
|
2012-01-13 22:58:39 +00:00
|
|
|
|
2012-01-13 22:58:40 +00:00
|
|
|
return bcma_bus_suspend(bus);
|
2011-12-09 21:16:07 +00:00
|
|
|
}
|
|
|
|
|
2012-01-13 22:58:39 +00:00
|
|
|
static int bcma_host_pci_resume(struct device *dev)
|
2011-12-09 21:16:07 +00:00
|
|
|
{
|
2012-01-13 22:58:39 +00:00
|
|
|
struct pci_dev *pdev = to_pci_dev(dev);
|
|
|
|
struct bcma_bus *bus = pci_get_drvdata(pdev);
|
2011-12-09 21:16:07 +00:00
|
|
|
|
2012-01-13 22:58:39 +00:00
|
|
|
return bcma_bus_resume(bus);
|
|
|
|
}
|
2011-12-09 21:16:07 +00:00
|
|
|
|
2012-01-13 22:58:39 +00:00
|
|
|
static SIMPLE_DEV_PM_OPS(bcma_pm_ops, bcma_host_pci_suspend,
|
|
|
|
bcma_host_pci_resume);
|
|
|
|
#define BCMA_PM_OPS (&bcma_pm_ops)
|
2011-12-09 21:16:07 +00:00
|
|
|
|
2012-10-16 14:59:02 +00:00
|
|
|
#else /* CONFIG_PM_SLEEP */
|
2012-01-13 22:58:39 +00:00
|
|
|
|
|
|
|
#define BCMA_PM_OPS NULL
|
|
|
|
|
2012-10-16 14:59:02 +00:00
|
|
|
#endif /* CONFIG_PM_SLEEP */
|
2011-12-09 21:16:07 +00:00
|
|
|
|
2013-12-02 23:00:27 +00:00
|
|
|
static const struct pci_device_id bcma_pci_bridge_tbl[] = {
|
2011-05-14 08:31:46 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x0576) },
|
2013-10-03 11:49:10 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4313) },
|
2014-10-15 05:51:44 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 43224) }, /* 0xa8d8 */
|
2011-05-09 16:56:46 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4331) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4353) },
|
2011-06-17 11:15:23 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4357) },
|
2012-09-21 06:38:38 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4358) },
|
2012-07-23 16:20:12 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4359) },
|
2013-06-26 08:02:11 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4365) },
|
2014-07-15 17:44:28 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x43a9) },
|
2014-07-24 13:29:19 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x43aa) },
|
2011-05-09 16:56:46 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4727) },
|
2014-10-15 05:51:44 +00:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 43227) }, /* 0xa8db, BCM43217 (sic!) */
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 43228) }, /* 0xa8dc */
|
2011-05-09 16:56:46 +00:00
|
|
|
{ 0, },
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pci, bcma_pci_bridge_tbl);
|
|
|
|
|
|
|
|
static struct pci_driver bcma_pci_bridge_driver = {
|
|
|
|
.name = "bcma-pci-bridge",
|
|
|
|
.id_table = bcma_pci_bridge_tbl,
|
|
|
|
.probe = bcma_host_pci_probe,
|
2012-12-21 23:12:59 +00:00
|
|
|
.remove = bcma_host_pci_remove,
|
2012-01-13 22:58:39 +00:00
|
|
|
.driver.pm = BCMA_PM_OPS,
|
2011-05-09 16:56:46 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
int __init bcma_host_pci_init(void)
|
|
|
|
{
|
|
|
|
return pci_register_driver(&bcma_pci_bridge_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
void __exit bcma_host_pci_exit(void)
|
|
|
|
{
|
|
|
|
pci_unregister_driver(&bcma_pci_bridge_driver);
|
|
|
|
}
|
2015-02-08 16:11:47 +00:00
|
|
|
|
|
|
|
/**************************************************
|
|
|
|
* Runtime ops for drivers.
|
|
|
|
**************************************************/
|
|
|
|
|
|
|
|
/* See also pcicore_up */
|
|
|
|
void bcma_host_pci_up(struct bcma_bus *bus)
|
|
|
|
{
|
|
|
|
if (bus->hosttype != BCMA_HOSTTYPE_PCI)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (bus->host_is_pcie2)
|
|
|
|
pr_warn("Bringing up bus with PCIe Gen 2 host is unsupported yet\n");
|
|
|
|
else
|
|
|
|
bcma_core_pci_up(&bus->drv_pci[0]);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(bcma_host_pci_up);
|
|
|
|
|
|
|
|
/* See also pcicore_down */
|
|
|
|
void bcma_host_pci_down(struct bcma_bus *bus)
|
|
|
|
{
|
|
|
|
if (bus->hosttype != BCMA_HOSTTYPE_PCI)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (!bus->host_is_pcie2)
|
|
|
|
bcma_core_pci_down(&bus->drv_pci[0]);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(bcma_host_pci_down);
|