/* * Broadcom specific AMBA * System on Chip (SoC) Host * * Licensed under the GNU/GPL. See COPYING for details. */ #include "bcma_private.h"#include "scan.h"#include <linux/slab.h>#include <linux/module.h>#include <linux/of_address.h>#include <linux/bcma/bcma.h>#include <linux/bcma/bcma_soc.h> static u8 bcma_host_soc_read8(struct bcma_device *core, u16 offset){	return readb(core->io_addr + offset);} static u16 bcma_host_soc_read16(struct bcma_device *core, u16 offset){	return readw(core->io_addr + offset);} static u32 bcma_host_soc_read32(struct bcma_device *core, u16 offset){	return readl(core->io_addr + offset);} static void bcma_host_soc_write8(struct bcma_device *core, u16 offset,				 u8 value){	writeb(value, core->io_addr + offset);} static void bcma_host_soc_write16(struct bcma_device *core, u16 offset,				 u16 value){	writew(value, core->io_addr + offset);} static void bcma_host_soc_write32(struct bcma_device *core, u16 offset,				 u32 value){	writel(value, core->io_addr + offset);} #ifdef CONFIG_BCMA_BLOCKIOstatic void bcma_host_soc_block_read(struct bcma_device *core, void *buffer,				     size_t count, u16 offset, u8 reg_width){	void __iomem *addr = core->io_addr + offset; 	switch (reg_width) {	case sizeof(u8): {		u8 *buf = buffer; 		while (count) {			*buf = __raw_readb(addr);			buf++;			count--;		}		break;	}	case sizeof(u16): {		__le16 *buf = buffer; 		WARN_ON(count & 1);		while (count) {			*buf = (__force __le16)__raw_readw(addr);			buf++;			count -= 2;		}		break;	}	case sizeof(u32): {		__le32 *buf = buffer; 		WARN_ON(count & 3);		while (count) {			*buf = (__force __le32)__raw_readl(addr);			buf++;			count -= 4;		}		break;	}	default:		WARN_ON(1);	}} static void bcma_host_soc_block_write(struct bcma_device *core,				      const void *buffer,				      size_t count, u16 offset, u8 reg_width){	void __iomem *addr = core->io_addr + offset; 	switch (reg_width) {	case sizeof(u8): {		const u8 *buf = buffer; 		while (count) {			__raw_writeb(*buf, addr);			buf++;			count--;		}		break;	}	case sizeof(u16): {		const __le16 *buf = buffer; 		WARN_ON(count & 1);		while (count) {			__raw_writew((__force u16)(*buf), addr);			buf++;			count -= 2;		}		break;	}	case sizeof(u32): {		const __le32 *buf = buffer; 		WARN_ON(count & 3);		while (count) {			__raw_writel((__force u32)(*buf), addr);			buf++;			count -= 4;		}		break;	}	default:		WARN_ON(1);	}}#endif /* CONFIG_BCMA_BLOCKIO */ static u32 bcma_host_soc_aread32(struct bcma_device *core, u16 offset){	if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))		return ~0;	return readl(core->io_wrap + offset);} static void bcma_host_soc_awrite32(struct bcma_device *core, u16 offset,				  u32 value){	if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))		return;	writel(value, core->io_wrap + offset);} static const struct bcma_host_ops bcma_host_soc_ops = {	.read8		= bcma_host_soc_read8,	.read16		= bcma_host_soc_read16,	.read32		= bcma_host_soc_read32,	.write8		= bcma_host_soc_write8,	.write16	= bcma_host_soc_write16,	.write32	= bcma_host_soc_write32,#ifdef CONFIG_BCMA_BLOCKIO	.block_read	= bcma_host_soc_block_read,	.block_write	= bcma_host_soc_block_write,#endif	.aread32	= bcma_host_soc_aread32,	.awrite32	= bcma_host_soc_awrite32,}; int __init bcma_host_soc_register(struct bcma_soc *soc){	struct bcma_bus *bus = &soc->bus; 	/* iomap only first core. We have to read some register on this core	 * to scan the bus.	 */	bus->mmio = ioremap(BCMA_ADDR_BASE, BCMA_CORE_SIZE * 1);	if (!bus->mmio)		return -ENOMEM; 	/* Host specific */	bus->hosttype = BCMA_HOSTTYPE_SOC;	bus->ops = &bcma_host_soc_ops; 	/* Initialize struct, detect chip */	bcma_init_bus(bus); 	return 0;} int __init bcma_host_soc_init(struct bcma_soc *soc){	struct bcma_bus *bus = &soc->bus;	int err; 	/* Scan bus and initialize it */	err = bcma_bus_early_register(bus);	if (err)		iounmap(bus->mmio); 	return err;} #ifdef CONFIG_OFstatic int bcma_host_soc_probe(struct platform_device *pdev){	struct device *dev = &pdev->dev;	struct device_node *np = dev->of_node;	struct bcma_bus *bus;	int err; 	/* Alloc */	bus = devm_kzalloc(dev, sizeof(*bus), GFP_KERNEL);	if (!bus)		return -ENOMEM; 	bus->dev = dev; 	/* Map MMIO */	bus->mmio = of_iomap(np, 0);	if (!bus->mmio)		return -ENOMEM; 	/* Host specific */	bus->hosttype = BCMA_HOSTTYPE_SOC;	bus->ops = &bcma_host_soc_ops; 	/* Initialize struct, detect chip */	bcma_init_bus(bus); 	/* Register */	err = bcma_bus_register(bus);	if (err)		goto err_unmap_mmio; 	platform_set_drvdata(pdev, bus); 	return err; err_unmap_mmio:	iounmap(bus->mmio);	return err;} static void bcma_host_soc_remove(struct platform_device *pdev){	struct bcma_bus *bus = platform_get_drvdata(pdev); 	bcma_bus_unregister(bus);	iounmap(bus->mmio);	platform_set_drvdata(pdev, NULL);} static const struct of_device_id bcma_host_soc_of_match[] = {	{ .compatible = "brcm,bus-axi", },	{},};MODULE_DEVICE_TABLE(of, bcma_host_soc_of_match); static struct platform_driver bcma_host_soc_driver = {	.driver = {		.name = "bcma-host-soc",		.of_match_table = bcma_host_soc_of_match,	},	.probe		= bcma_host_soc_probe,	.remove		= bcma_host_soc_remove,}; int __init bcma_host_soc_register_driver(void){	return platform_driver_register(&bcma_host_soc_driver);} void __exit bcma_host_soc_unregister_driver(void){	platform_driver_unregister(&bcma_host_soc_driver);}#endif /* CONFIG_OF */