[deliverable/linux.git] / drivers / bcma / scan.c

/*
 * Broadcom specific AMBA
 * Bus scanning
 *
 * Licensed under the GNU/GPL. See COPYING for details.
 */

#include "scan.h"
#include "bcma_private.h"

#include <linux/bcma/bcma.h>
#include <linux/bcma/bcma_regs.h>
#include <linux/pci.h>
#include <linux/io.h>
#include <linux/dma-mapping.h>
#include <linux/slab.h>

struct bcma_device_id_name {
	u16 id;
	const char *name;
};

static const struct bcma_device_id_name bcma_arm_device_names[] = {
	{ BCMA_CORE_4706_MAC_GBIT_COMMON, "BCM4706 GBit MAC Common" },
	{ BCMA_CORE_ARM_1176, "ARM 1176" },
	{ BCMA_CORE_ARM_7TDMI, "ARM 7TDMI" },
	{ BCMA_CORE_ARM_CM3, "ARM CM3" },
};

static const struct bcma_device_id_name bcma_bcm_device_names[] = {
	{ BCMA_CORE_OOB_ROUTER, "OOB Router" },
	{ BCMA_CORE_4706_CHIPCOMMON, "BCM4706 ChipCommon" },
	{ BCMA_CORE_4706_SOC_RAM, "BCM4706 SOC RAM" },
	{ BCMA_CORE_4706_MAC_GBIT, "BCM4706 GBit MAC" },
	{ BCMA_CORE_PCIEG2, "PCIe Gen 2" },
	{ BCMA_CORE_DMA, "DMA" },
	{ BCMA_CORE_SDIO3, "SDIO3" },
	{ BCMA_CORE_USB20, "USB 2.0" },
	{ BCMA_CORE_USB30, "USB 3.0" },
	{ BCMA_CORE_A9JTAG, "ARM Cortex A9 JTAG" },
	{ BCMA_CORE_DDR23, "Denali DDR2/DDR3 memory controller" },
	{ BCMA_CORE_ROM, "ROM" },
	{ BCMA_CORE_NAND, "NAND flash controller" },
	{ BCMA_CORE_QSPI, "SPI flash controller" },
	{ BCMA_CORE_CHIPCOMMON_B, "Chipcommon B" },
	{ BCMA_CORE_ARMCA9, "ARM Cortex A9 core (ihost)" },
	{ BCMA_CORE_AMEMC, "AMEMC (DDR)" },
	{ BCMA_CORE_ALTA, "ALTA (I2S)" },
	{ BCMA_CORE_INVALID, "Invalid" },
	{ BCMA_CORE_CHIPCOMMON, "ChipCommon" },
	{ BCMA_CORE_ILINE20, "ILine 20" },
	{ BCMA_CORE_SRAM, "SRAM" },
	{ BCMA_CORE_SDRAM, "SDRAM" },
	{ BCMA_CORE_PCI, "PCI" },
	{ BCMA_CORE_ETHERNET, "Fast Ethernet" },
	{ BCMA_CORE_V90, "V90" },
	{ BCMA_CORE_USB11_HOSTDEV, "USB 1.1 Hostdev" },
	{ BCMA_CORE_ADSL, "ADSL" },
	{ BCMA_CORE_ILINE100, "ILine 100" },
	{ BCMA_CORE_IPSEC, "IPSEC" },
	{ BCMA_CORE_UTOPIA, "UTOPIA" },
	{ BCMA_CORE_PCMCIA, "PCMCIA" },
	{ BCMA_CORE_INTERNAL_MEM, "Internal Memory" },
	{ BCMA_CORE_MEMC_SDRAM, "MEMC SDRAM" },
	{ BCMA_CORE_OFDM, "OFDM" },
	{ BCMA_CORE_EXTIF, "EXTIF" },
	{ BCMA_CORE_80211, "IEEE 802.11" },
	{ BCMA_CORE_PHY_A, "PHY A" },
	{ BCMA_CORE_PHY_B, "PHY B" },
	{ BCMA_CORE_PHY_G, "PHY G" },
	{ BCMA_CORE_USB11_HOST, "USB 1.1 Host" },
	{ BCMA_CORE_USB11_DEV, "USB 1.1 Device" },
	{ BCMA_CORE_USB20_HOST, "USB 2.0 Host" },
	{ BCMA_CORE_USB20_DEV, "USB 2.0 Device" },
	{ BCMA_CORE_SDIO_HOST, "SDIO Host" },
	{ BCMA_CORE_ROBOSWITCH, "Roboswitch" },
	{ BCMA_CORE_PARA_ATA, "PATA" },
	{ BCMA_CORE_SATA_XORDMA, "SATA XOR-DMA" },
	{ BCMA_CORE_ETHERNET_GBIT, "GBit Ethernet" },
	{ BCMA_CORE_PCIE, "PCIe" },
	{ BCMA_CORE_PHY_N, "PHY N" },
	{ BCMA_CORE_SRAM_CTL, "SRAM Controller" },
	{ BCMA_CORE_MINI_MACPHY, "Mini MACPHY" },
	{ BCMA_CORE_PHY_LP, "PHY LP" },
	{ BCMA_CORE_PMU, "PMU" },
	{ BCMA_CORE_PHY_SSN, "PHY SSN" },
	{ BCMA_CORE_SDIO_DEV, "SDIO Device" },
	{ BCMA_CORE_PHY_HT, "PHY HT" },
	{ BCMA_CORE_MAC_GBIT, "GBit MAC" },
	{ BCMA_CORE_DDR12_MEM_CTL, "DDR1/DDR2 Memory Controller" },
	{ BCMA_CORE_PCIE_RC, "PCIe Root Complex" },
	{ BCMA_CORE_OCP_OCP_BRIDGE, "OCP to OCP Bridge" },
	{ BCMA_CORE_SHARED_COMMON, "Common Shared" },
	{ BCMA_CORE_OCP_AHB_BRIDGE, "OCP to AHB Bridge" },
	{ BCMA_CORE_SPI_HOST, "SPI Host" },
	{ BCMA_CORE_I2S, "I2S" },
	{ BCMA_CORE_SDR_DDR1_MEM_CTL, "SDR/DDR1 Memory Controller" },
	{ BCMA_CORE_SHIM, "SHIM" },
	{ BCMA_CORE_PCIE2, "PCIe Gen2" },
	{ BCMA_CORE_ARM_CR4, "ARM CR4" },
	{ BCMA_CORE_DEFAULT, "Default" },
};

static const struct bcma_device_id_name bcma_mips_device_names[] = {
	{ BCMA_CORE_MIPS, "MIPS" },
	{ BCMA_CORE_MIPS_3302, "MIPS 3302" },
	{ BCMA_CORE_MIPS_74K, "MIPS 74K" },
};

static const char *bcma_device_name(const struct bcma_device_id *id)
{
	const struct bcma_device_id_name *names;
	int size, i;

	/* search manufacturer specific names */
	switch (id->manuf) {
	case BCMA_MANUF_ARM:
		names = bcma_arm_device_names;
		size = ARRAY_SIZE(bcma_arm_device_names);
		break;
	case BCMA_MANUF_BCM:
		names = bcma_bcm_device_names;
		size = ARRAY_SIZE(bcma_bcm_device_names);
		break;
	case BCMA_MANUF_MIPS:
		names = bcma_mips_device_names;
		size = ARRAY_SIZE(bcma_mips_device_names);
		break;
	default:
		return "UNKNOWN";
	}

	for (i = 0; i < size; i++) {
		if (names[i].id == id->id)
			return names[i].name;
	}

	return "UNKNOWN";
}

static u32 bcma_scan_read32(struct bcma_bus *bus, u8 current_coreidx,
		       u16 offset)
{
	return readl(bus->mmio + offset);
}

static void bcma_scan_switch_core(struct bcma_bus *bus, u32 addr)
{
	if (bus->hosttype == BCMA_HOSTTYPE_PCI)
		pci_write_config_dword(bus->host_pci, BCMA_PCI_BAR0_WIN,
				       addr);
}

static u32 bcma_erom_get_ent(struct bcma_bus *bus, u32 __iomem **eromptr)
{
	u32 ent = readl(*eromptr);
	(*eromptr)++;
	return ent;
}

static void bcma_erom_push_ent(u32 __iomem **eromptr)
{
	(*eromptr)--;
}

static s32 bcma_erom_get_ci(struct bcma_bus *bus, u32 __iomem **eromptr)
{
	u32 ent = bcma_erom_get_ent(bus, eromptr);
	if (!(ent & SCAN_ER_VALID))
		return -ENOENT;
	if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_CI)
		return -ENOENT;
	return ent;
}

static bool bcma_erom_is_end(struct bcma_bus *bus, u32 __iomem **eromptr)
{
	u32 ent = bcma_erom_get_ent(bus, eromptr);
	bcma_erom_push_ent(eromptr);
	return (ent == (SCAN_ER_TAG_END | SCAN_ER_VALID));
}

static bool bcma_erom_is_bridge(struct bcma_bus *bus, u32 __iomem **eromptr)
{
	u32 ent = bcma_erom_get_ent(bus, eromptr);
	bcma_erom_push_ent(eromptr);
	return (((ent & SCAN_ER_VALID)) &&
		((ent & SCAN_ER_TAGX) == SCAN_ER_TAG_ADDR) &&
		((ent & SCAN_ADDR_TYPE) == SCAN_ADDR_TYPE_BRIDGE));
}

static void bcma_erom_skip_component(struct bcma_bus *bus, u32 __iomem **eromptr)
{
	u32 ent;
	while (1) {
		ent = bcma_erom_get_ent(bus, eromptr);
		if ((ent & SCAN_ER_VALID) &&
		    ((ent & SCAN_ER_TAG) == SCAN_ER_TAG_CI))
			break;
		if (ent == (SCAN_ER_TAG_END | SCAN_ER_VALID))
			break;
	}
	bcma_erom_push_ent(eromptr);
}

static s32 bcma_erom_get_mst_port(struct bcma_bus *bus, u32 __iomem **eromptr)
{
	u32 ent = bcma_erom_get_ent(bus, eromptr);
	if (!(ent & SCAN_ER_VALID))
		return -ENOENT;
	if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_MP)
		return -ENOENT;
	return ent;
}

static u32 bcma_erom_get_addr_desc(struct bcma_bus *bus, u32 __iomem **eromptr,
				  u32 type, u8 port)
{
	u32 addrl, addrh, sizel, sizeh = 0;
	u32 size;

	u32 ent = bcma_erom_get_ent(bus, eromptr);
	if ((!(ent & SCAN_ER_VALID)) ||
	    ((ent & SCAN_ER_TAGX) != SCAN_ER_TAG_ADDR) ||
	    ((ent & SCAN_ADDR_TYPE) != type) ||
	    (((ent & SCAN_ADDR_PORT) >> SCAN_ADDR_PORT_SHIFT) != port)) {
		bcma_erom_push_ent(eromptr);
		return (u32)-EINVAL;
	}

	addrl = ent & SCAN_ADDR_ADDR;
	if (ent & SCAN_ADDR_AG32)
		addrh = bcma_erom_get_ent(bus, eromptr);
	else
		addrh = 0;

	if ((ent & SCAN_ADDR_SZ) == SCAN_ADDR_SZ_SZD) {
		size = bcma_erom_get_ent(bus, eromptr);
		sizel = size & SCAN_SIZE_SZ;
		if (size & SCAN_SIZE_SG32)
			sizeh = bcma_erom_get_ent(bus, eromptr);
	} else
		sizel = SCAN_ADDR_SZ_BASE <<
				((ent & SCAN_ADDR_SZ) >> SCAN_ADDR_SZ_SHIFT);

	return addrl;
}

static struct bcma_device *bcma_find_core_by_index(struct bcma_bus *bus,
						   u16 index)
{
	struct bcma_device *core;

	list_for_each_entry(core, &bus->cores, list) {
		if (core->core_index == index)
			return core;
	}
	return NULL;
}

static struct bcma_device *bcma_find_core_reverse(struct bcma_bus *bus, u16 coreid)
{
	struct bcma_device *core;

	list_for_each_entry_reverse(core, &bus->cores, list) {
		if (core->id.id == coreid)
			return core;
	}
	return NULL;
}

static int bcma_get_next_core(struct bcma_bus *bus, u32 __iomem **eromptr,
			      struct bcma_device_id *match, int core_num,
			      struct bcma_device *core)
{
	u32 tmp;
	u8 i, j;
	s32 cia, cib;
	u8 ports[2], wrappers[2];

	/* get CIs */
	cia = bcma_erom_get_ci(bus, eromptr);
	if (cia < 0) {
		bcma_erom_push_ent(eromptr);
		if (bcma_erom_is_end(bus, eromptr))
			return -ESPIPE;
		return -EILSEQ;
	}
	cib = bcma_erom_get_ci(bus, eromptr);
	if (cib < 0)
		return -EILSEQ;

	/* parse CIs */
	core->id.class = (cia & SCAN_CIA_CLASS) >> SCAN_CIA_CLASS_SHIFT;
	core->id.id = (cia & SCAN_CIA_ID) >> SCAN_CIA_ID_SHIFT;
	core->id.manuf = (cia & SCAN_CIA_MANUF) >> SCAN_CIA_MANUF_SHIFT;
	ports[0] = (cib & SCAN_CIB_NMP) >> SCAN_CIB_NMP_SHIFT;
	ports[1] = (cib & SCAN_CIB_NSP) >> SCAN_CIB_NSP_SHIFT;
	wrappers[0] = (cib & SCAN_CIB_NMW) >> SCAN_CIB_NMW_SHIFT;
	wrappers[1] = (cib & SCAN_CIB_NSW) >> SCAN_CIB_NSW_SHIFT;
	core->id.rev = (cib & SCAN_CIB_REV) >> SCAN_CIB_REV_SHIFT;

	if (((core->id.manuf == BCMA_MANUF_ARM) &&
	     (core->id.id == 0xFFF)) ||
	    (ports[1] == 0)) {
		bcma_erom_skip_component(bus, eromptr);
		return -ENXIO;
	}

	/* check if component is a core at all */
	if (wrappers[0] + wrappers[1] == 0) {
		/* Some specific cores don't need wrappers */
		switch (core->id.id) {
		case BCMA_CORE_4706_MAC_GBIT_COMMON:
		/* Not used yet: case BCMA_CORE_OOB_ROUTER: */
			break;
		default:
			bcma_erom_skip_component(bus, eromptr);
			return -ENXIO;
		}
	}

	if (bcma_erom_is_bridge(bus, eromptr)) {
		bcma_erom_skip_component(bus, eromptr);
		return -ENXIO;
	}

	if (bcma_find_core_by_index(bus, core_num)) {
		bcma_erom_skip_component(bus, eromptr);
		return -ENODEV;
	}

	if (match && ((match->manuf != BCMA_ANY_MANUF &&
	      match->manuf != core->id.manuf) ||
	     (match->id != BCMA_ANY_ID && match->id != core->id.id) ||
	     (match->rev != BCMA_ANY_REV && match->rev != core->id.rev) ||
	     (match->class != BCMA_ANY_CLASS && match->class != core->id.class)
	    )) {
		bcma_erom_skip_component(bus, eromptr);
		return -ENODEV;
	}

	/* get & parse master ports */
	for (i = 0; i < ports[0]; i++) {
		s32 mst_port_d = bcma_erom_get_mst_port(bus, eromptr);
		if (mst_port_d < 0)
			return -EILSEQ;
	}

	/* First Slave Address Descriptor should be port 0:
	 * the main register space for the core
	 */
	tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, 0);
	if (tmp == 0 || IS_ERR_VALUE(tmp)) {
		/* Try again to see if it is a bridge */
		tmp = bcma_erom_get_addr_desc(bus, eromptr,
					      SCAN_ADDR_TYPE_BRIDGE, 0);
		if (tmp == 0 || IS_ERR_VALUE(tmp)) {
			return -EILSEQ;
		} else {
			bcma_info(bus, "Bridge found\n");
			return -ENXIO;
		}
	}
	core->addr = tmp;

	/* get & parse slave ports */
	for (i = 0; i < ports[1]; i++) {
		for (j = 0; ; j++) {
			tmp = bcma_erom_get_addr_desc(bus, eromptr,
				SCAN_ADDR_TYPE_SLAVE, i);
			if (IS_ERR_VALUE(tmp)) {
				/* no more entries for port _i_ */
				/* pr_debug("erom: slave port %d "
				 * "has %d descriptors\n", i, j); */
				break;
			} else {
				if (i == 0 && j == 0)
					core->addr1 = tmp;
			}
		}
	}

	/* get & parse master wrappers */
	for (i = 0; i < wrappers[0]; i++) {
		for (j = 0; ; j++) {
			tmp = bcma_erom_get_addr_desc(bus, eromptr,
				SCAN_ADDR_TYPE_MWRAP, i);
			if (IS_ERR_VALUE(tmp)) {
				/* no more entries for port _i_ */
				/* pr_debug("erom: master wrapper %d "
				 * "has %d descriptors\n", i, j); */
				break;
			} else {
				if (i == 0 && j == 0)
					core->wrap = tmp;
			}
		}
	}

	/* get & parse slave wrappers */
	for (i = 0; i < wrappers[1]; i++) {
		u8 hack = (ports[1] == 1) ? 0 : 1;
		for (j = 0; ; j++) {
			tmp = bcma_erom_get_addr_desc(bus, eromptr,
				SCAN_ADDR_TYPE_SWRAP, i + hack);
			if (IS_ERR_VALUE(tmp)) {
				/* no more entries for port _i_ */
				/* pr_debug("erom: master wrapper %d "
				 * has %d descriptors\n", i, j); */
				break;
			} else {
				if (wrappers[0] == 0 && !i && !j)
					core->wrap = tmp;
			}
		}
	}
	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
		core->io_addr = ioremap_nocache(core->addr, BCMA_CORE_SIZE);
		if (!core->io_addr)
			return -ENOMEM;
		core->io_wrap = ioremap_nocache(core->wrap, BCMA_CORE_SIZE);
		if (!core->io_wrap) {
			iounmap(core->io_addr);
			return -ENOMEM;
		}
	}
	return 0;
}

void bcma_init_bus(struct bcma_bus *bus)
{
	s32 tmp;
	struct bcma_chipinfo *chipinfo = &(bus->chipinfo);

	if (bus->init_done)
		return;

	INIT_LIST_HEAD(&bus->cores);
	bus->nr_cores = 0;

	bcma_scan_switch_core(bus, BCMA_ADDR_BASE);

	tmp = bcma_scan_read32(bus, 0, BCMA_CC_ID);
	chipinfo->id = (tmp & BCMA_CC_ID_ID) >> BCMA_CC_ID_ID_SHIFT;
	chipinfo->rev = (tmp & BCMA_CC_ID_REV) >> BCMA_CC_ID_REV_SHIFT;
	chipinfo->pkg = (tmp & BCMA_CC_ID_PKG) >> BCMA_CC_ID_PKG_SHIFT;
	bcma_info(bus, "Found chip with id 0x%04X, rev 0x%02X and package 0x%02X\n",
		  chipinfo->id, chipinfo->rev, chipinfo->pkg);

	bus->init_done = true;
}

int bcma_bus_scan(struct bcma_bus *bus)
{
	u32 erombase;
	u32 __iomem *eromptr, *eromend;

	int err, core_num = 0;

	bcma_init_bus(bus);

	erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
		eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE);
		if (!eromptr)
			return -ENOMEM;
	} else {
		eromptr = bus->mmio;
	}

	eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);

	bcma_scan_switch_core(bus, erombase);

	while (eromptr < eromend) {
		struct bcma_device *other_core;
		struct bcma_device *core = kzalloc(sizeof(*core), GFP_KERNEL);
		if (!core) {
			err = -ENOMEM;
			goto out;
		}
		INIT_LIST_HEAD(&core->list);
		core->bus = bus;

		err = bcma_get_next_core(bus, &eromptr, NULL, core_num, core);
		if (err < 0) {
			kfree(core);
			if (err == -ENODEV) {
				core_num++;
				continue;
			} else if (err == -ENXIO) {
				continue;
			} else if (err == -ESPIPE) {
				break;
			}
			goto out;
		}

		core->core_index = core_num++;
		bus->nr_cores++;
		other_core = bcma_find_core_reverse(bus, core->id.id);
		core->core_unit = (other_core == NULL) ? 0 : other_core->core_unit + 1;

		bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
			  core->core_index, bcma_device_name(&core->id),
			  core->id.manuf, core->id.id, core->id.rev,
			  core->id.class);

		list_add_tail(&core->list, &bus->cores);
	}

	err = 0;
out:
	if (bus->hosttype == BCMA_HOSTTYPE_SOC)
		iounmap(eromptr);

	return err;
}

int __init bcma_bus_scan_early(struct bcma_bus *bus,
			       struct bcma_device_id *match,
			       struct bcma_device *core)
{
	u32 erombase;
	u32 __iomem *eromptr, *eromend;

	int err = -ENODEV;
	int core_num = 0;

	erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
		eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE);
		if (!eromptr)
			return -ENOMEM;
	} else {
		eromptr = bus->mmio;
	}

	eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);

	bcma_scan_switch_core(bus, erombase);

	while (eromptr < eromend) {
		memset(core, 0, sizeof(*core));
		INIT_LIST_HEAD(&core->list);
		core->bus = bus;

		err = bcma_get_next_core(bus, &eromptr, match, core_num, core);
		if (err == -ENODEV) {
			core_num++;
			continue;
		} else if (err == -ENXIO)
			continue;
		else if (err == -ESPIPE)
			break;
		else if (err < 0)
			goto out;

		core->core_index = core_num++;
		bus->nr_cores++;
		bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
			  core->core_index, bcma_device_name(&core->id),
			  core->id.manuf, core->id.id, core->id.rev,
			  core->id.class);

		list_add_tail(&core->list, &bus->cores);
		err = 0;
		break;
	}

out:
	if (bus->hosttype == BCMA_HOSTTYPE_SOC)
		iounmap(eromptr);

	return err;
}
Commit	Line	Data
8369ae33 RM	1	/*
	2	* Broadcom specific AMBA
	3	* Bus scanning
	4	*
	5	* Licensed under the GNU/GPL. See COPYING for details.
	6	*/
	7
	8	#include "scan.h"
	9	#include "bcma_private.h"
	10
	11	#include <linux/bcma/bcma.h>
	12	#include <linux/bcma/bcma_regs.h>
	13	#include <linux/pci.h>
	14	#include <linux/io.h>
	15	#include <linux/dma-mapping.h>
	16	#include <linux/slab.h>
	17
	18	struct bcma_device_id_name {
	19	u16 id;
	20	const char *name;
	21	};
82a7c2bb NH	22
82a7c2bb NH	23	static const struct bcma_device_id_name bcma_arm_device_names[] = {
e1ac4b40	24	{ BCMA_CORE_4706_MAC_GBIT_COMMON, "BCM4706 GBit MAC Common" },
82a7c2bb NH	25	{ BCMA_CORE_ARM_1176, "ARM 1176" },
	26	{ BCMA_CORE_ARM_7TDMI, "ARM 7TDMI" },
	27	{ BCMA_CORE_ARM_CM3, "ARM CM3" },
	28	};
	29
	30	static const struct bcma_device_id_name bcma_bcm_device_names[] = {
8369ae33	31	{ BCMA_CORE_OOB_ROUTER, "OOB Router" },
d2bb2b9e RM	32	{ BCMA_CORE_4706_CHIPCOMMON, "BCM4706 ChipCommon" },
	33	{ BCMA_CORE_4706_SOC_RAM, "BCM4706 SOC RAM" },
	34	{ BCMA_CORE_4706_MAC_GBIT, "BCM4706 GBit MAC" },
bb4997a1 HM	35	{ BCMA_CORE_PCIEG2, "PCIe Gen 2" },
	36	{ BCMA_CORE_DMA, "DMA" },
	37	{ BCMA_CORE_SDIO3, "SDIO3" },
	38	{ BCMA_CORE_USB20, "USB 2.0" },
	39	{ BCMA_CORE_USB30, "USB 3.0" },
	40	{ BCMA_CORE_A9JTAG, "ARM Cortex A9 JTAG" },
	41	{ BCMA_CORE_DDR23, "Denali DDR2/DDR3 memory controller" },
	42	{ BCMA_CORE_ROM, "ROM" },
	43	{ BCMA_CORE_NAND, "NAND flash controller" },
	44	{ BCMA_CORE_QSPI, "SPI flash controller" },
	45	{ BCMA_CORE_CHIPCOMMON_B, "Chipcommon B" },
	46	{ BCMA_CORE_ARMCA9, "ARM Cortex A9 core (ihost)" },
d2bb2b9e RM	47	{ BCMA_CORE_AMEMC, "AMEMC (DDR)" },
d2bb2b9e RM	48	{ BCMA_CORE_ALTA, "ALTA (I2S)" },
8369ae33 RM	49	{ BCMA_CORE_INVALID, "Invalid" },
	50	{ BCMA_CORE_CHIPCOMMON, "ChipCommon" },
	51	{ BCMA_CORE_ILINE20, "ILine 20" },
	52	{ BCMA_CORE_SRAM, "SRAM" },
	53	{ BCMA_CORE_SDRAM, "SDRAM" },
	54	{ BCMA_CORE_PCI, "PCI" },
8369ae33 RM	55	{ BCMA_CORE_ETHERNET, "Fast Ethernet" },
	56	{ BCMA_CORE_V90, "V90" },
	57	{ BCMA_CORE_USB11_HOSTDEV, "USB 1.1 Hostdev" },
	58	{ BCMA_CORE_ADSL, "ADSL" },
	59	{ BCMA_CORE_ILINE100, "ILine 100" },
	60	{ BCMA_CORE_IPSEC, "IPSEC" },
	61	{ BCMA_CORE_UTOPIA, "UTOPIA" },
	62	{ BCMA_CORE_PCMCIA, "PCMCIA" },
	63	{ BCMA_CORE_INTERNAL_MEM, "Internal Memory" },
	64	{ BCMA_CORE_MEMC_SDRAM, "MEMC SDRAM" },
	65	{ BCMA_CORE_OFDM, "OFDM" },
	66	{ BCMA_CORE_EXTIF, "EXTIF" },
	67	{ BCMA_CORE_80211, "IEEE 802.11" },
	68	{ BCMA_CORE_PHY_A, "PHY A" },
	69	{ BCMA_CORE_PHY_B, "PHY B" },
	70	{ BCMA_CORE_PHY_G, "PHY G" },
8369ae33 RM	71	{ BCMA_CORE_USB11_HOST, "USB 1.1 Host" },
	72	{ BCMA_CORE_USB11_DEV, "USB 1.1 Device" },
	73	{ BCMA_CORE_USB20_HOST, "USB 2.0 Host" },
	74	{ BCMA_CORE_USB20_DEV, "USB 2.0 Device" },
	75	{ BCMA_CORE_SDIO_HOST, "SDIO Host" },
	76	{ BCMA_CORE_ROBOSWITCH, "Roboswitch" },
	77	{ BCMA_CORE_PARA_ATA, "PATA" },
	78	{ BCMA_CORE_SATA_XORDMA, "SATA XOR-DMA" },
	79	{ BCMA_CORE_ETHERNET_GBIT, "GBit Ethernet" },
	80	{ BCMA_CORE_PCIE, "PCIe" },
	81	{ BCMA_CORE_PHY_N, "PHY N" },
	82	{ BCMA_CORE_SRAM_CTL, "SRAM Controller" },
	83	{ BCMA_CORE_MINI_MACPHY, "Mini MACPHY" },
8369ae33 RM	84	{ BCMA_CORE_PHY_LP, "PHY LP" },
	85	{ BCMA_CORE_PMU, "PMU" },
	86	{ BCMA_CORE_PHY_SSN, "PHY SSN" },
	87	{ BCMA_CORE_SDIO_DEV, "SDIO Device" },
8369ae33	88	{ BCMA_CORE_PHY_HT, "PHY HT" },
8369ae33 RM	89	{ BCMA_CORE_MAC_GBIT, "GBit MAC" },
	90	{ BCMA_CORE_DDR12_MEM_CTL, "DDR1/DDR2 Memory Controller" },
	91	{ BCMA_CORE_PCIE_RC, "PCIe Root Complex" },
	92	{ BCMA_CORE_OCP_OCP_BRIDGE, "OCP to OCP Bridge" },
	93	{ BCMA_CORE_SHARED_COMMON, "Common Shared" },
	94	{ BCMA_CORE_OCP_AHB_BRIDGE, "OCP to AHB Bridge" },
	95	{ BCMA_CORE_SPI_HOST, "SPI Host" },
	96	{ BCMA_CORE_I2S, "I2S" },
	97	{ BCMA_CORE_SDR_DDR1_MEM_CTL, "SDR/DDR1 Memory Controller" },
	98	{ BCMA_CORE_SHIM, "SHIM" },
d4988d4c RM	99	{ BCMA_CORE_PCIE2, "PCIe Gen2" },
d4988d4c RM	100	{ BCMA_CORE_ARM_CR4, "ARM CR4" },
8369ae33 RM	101	{ BCMA_CORE_DEFAULT, "Default" },
8369ae33 RM	102	};
82a7c2bb NH	103
	104	static const struct bcma_device_id_name bcma_mips_device_names[] = {
	105	{ BCMA_CORE_MIPS, "MIPS" },
	106	{ BCMA_CORE_MIPS_3302, "MIPS 3302" },
	107	{ BCMA_CORE_MIPS_74K, "MIPS 74K" },
	108	};
	109
	110	static const char bcma_device_name(const struct bcma_device_id id)
8369ae33	111	{
82a7c2bb NH	112	const struct bcma_device_id_name *names;
82a7c2bb NH	113	int size, i;
8369ae33	114
82a7c2bb NH	115	/* search manufacturer specific names */
	116	switch (id->manuf) {
	117	case BCMA_MANUF_ARM:
	118	names = bcma_arm_device_names;
	119	size = ARRAY_SIZE(bcma_arm_device_names);
	120	break;
	121	case BCMA_MANUF_BCM:
	122	names = bcma_bcm_device_names;
	123	size = ARRAY_SIZE(bcma_bcm_device_names);
	124	break;
	125	case BCMA_MANUF_MIPS:
	126	names = bcma_mips_device_names;
	127	size = ARRAY_SIZE(bcma_mips_device_names);
	128	break;
	129	default:
	130	return "UNKNOWN";
8369ae33	131	}
82a7c2bb NH	132
	133	for (i = 0; i < size; i++) {
	134	if (names[i].id == id->id)
	135	return names[i].name;
	136	}
	137
8369ae33 RM	138	return "UNKNOWN";
	139	}
	140
	141	static u32 bcma_scan_read32(struct bcma_bus *bus, u8 current_coreidx,
	142	u16 offset)
	143	{
	144	return readl(bus->mmio + offset);
	145	}
	146
	147	static void bcma_scan_switch_core(struct bcma_bus *bus, u32 addr)
	148	{
	149	if (bus->hosttype == BCMA_HOSTTYPE_PCI)
	150	pci_write_config_dword(bus->host_pci, BCMA_PCI_BAR0_WIN,
	151	addr);
	152	}
	153
0b8d6e59	154	static u32 bcma_erom_get_ent(struct bcma_bus bus, u32 __iomem *eromptr)
8369ae33 RM	155	{
	156	u32 ent = readl(*eromptr);
	157	(*eromptr)++;
	158	return ent;
	159	}
	160
0b8d6e59	161	static void bcma_erom_push_ent(u32 __iomem **eromptr)
8369ae33 RM	162	{
	163	(*eromptr)--;
	164	}
	165
0b8d6e59	166	static s32 bcma_erom_get_ci(struct bcma_bus bus, u32 __iomem *eromptr)
8369ae33 RM	167	{
	168	u32 ent = bcma_erom_get_ent(bus, eromptr);
	169	if (!(ent & SCAN_ER_VALID))
	170	return -ENOENT;
	171	if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_CI)
	172	return -ENOENT;
	173	return ent;
	174	}
	175
0b8d6e59	176	static bool bcma_erom_is_end(struct bcma_bus bus, u32 __iomem *eromptr)
8369ae33 RM	177	{
	178	u32 ent = bcma_erom_get_ent(bus, eromptr);
	179	bcma_erom_push_ent(eromptr);
	180	return (ent == (SCAN_ER_TAG_END \| SCAN_ER_VALID));
	181	}
	182
0b8d6e59	183	static bool bcma_erom_is_bridge(struct bcma_bus bus, u32 __iomem *eromptr)
8369ae33 RM	184	{
	185	u32 ent = bcma_erom_get_ent(bus, eromptr);
	186	bcma_erom_push_ent(eromptr);
	187	return (((ent & SCAN_ER_VALID)) &&
	188	((ent & SCAN_ER_TAGX) == SCAN_ER_TAG_ADDR) &&
	189	((ent & SCAN_ADDR_TYPE) == SCAN_ADDR_TYPE_BRIDGE));
	190	}
	191
0b8d6e59	192	static void bcma_erom_skip_component(struct bcma_bus bus, u32 __iomem *eromptr)
8369ae33 RM	193	{
	194	u32 ent;
	195	while (1) {
	196	ent = bcma_erom_get_ent(bus, eromptr);
	197	if ((ent & SCAN_ER_VALID) &&
	198	((ent & SCAN_ER_TAG) == SCAN_ER_TAG_CI))
	199	break;
	200	if (ent == (SCAN_ER_TAG_END \| SCAN_ER_VALID))
	201	break;
	202	}
	203	bcma_erom_push_ent(eromptr);
	204	}
	205
0b8d6e59	206	static s32 bcma_erom_get_mst_port(struct bcma_bus bus, u32 __iomem *eromptr)
8369ae33 RM	207	{
	208	u32 ent = bcma_erom_get_ent(bus, eromptr);
	209	if (!(ent & SCAN_ER_VALID))
	210	return -ENOENT;
	211	if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_MP)
	212	return -ENOENT;
	213	return ent;
	214	}
	215
fd4edf19	216	static u32 bcma_erom_get_addr_desc(struct bcma_bus bus, u32 __iomem *eromptr,
8369ae33 RM	217	u32 type, u8 port)
	218	{
	219	u32 addrl, addrh, sizel, sizeh = 0;
	220	u32 size;
	221
	222	u32 ent = bcma_erom_get_ent(bus, eromptr);
	223	if ((!(ent & SCAN_ER_VALID)) \|\|
	224	((ent & SCAN_ER_TAGX) != SCAN_ER_TAG_ADDR) \|\|
	225	((ent & SCAN_ADDR_TYPE) != type) \|\|
	226	(((ent & SCAN_ADDR_PORT) >> SCAN_ADDR_PORT_SHIFT) != port)) {
	227	bcma_erom_push_ent(eromptr);
fd4edf19	228	return (u32)-EINVAL;
8369ae33 RM	229	}
	230
	231	addrl = ent & SCAN_ADDR_ADDR;
	232	if (ent & SCAN_ADDR_AG32)
	233	addrh = bcma_erom_get_ent(bus, eromptr);
	234	else
	235	addrh = 0;
	236
	237	if ((ent & SCAN_ADDR_SZ) == SCAN_ADDR_SZ_SZD) {
	238	size = bcma_erom_get_ent(bus, eromptr);
	239	sizel = size & SCAN_SIZE_SZ;
	240	if (size & SCAN_SIZE_SG32)
	241	sizeh = bcma_erom_get_ent(bus, eromptr);
	242	} else
	243	sizel = SCAN_ADDR_SZ_BASE <<
	244	((ent & SCAN_ADDR_SZ) >> SCAN_ADDR_SZ_SHIFT);
	245
	246	return addrl;
	247	}
	248
517f43e5 HM	249	static struct bcma_device bcma_find_core_by_index(struct bcma_bus bus,
	250	u16 index)
	251	{
	252	struct bcma_device *core;
	253
	254	list_for_each_entry(core, &bus->cores, list) {
	255	if (core->core_index == index)
	256	return core;
	257	}
	258	return NULL;
	259	}
	260
5f2d6171 HM	261	static struct bcma_device bcma_find_core_reverse(struct bcma_bus bus, u16 coreid)
	262	{
	263	struct bcma_device *core;
	264
	265	list_for_each_entry_reverse(core, &bus->cores, list) {
	266	if (core->id.id == coreid)
	267	return core;
	268	}
	269	return NULL;
	270	}
	271
982eee67	272	static int bcma_get_next_core(struct bcma_bus bus, u32 __iomem *eromptr,
517f43e5	273	struct bcma_device_id *match, int core_num,
982eee67 HM	274	struct bcma_device *core)
982eee67 HM	275	{
fd4edf19	276	u32 tmp;
982eee67 HM	277	u8 i, j;
	278	s32 cia, cib;
	279	u8 ports[2], wrappers[2];
	280
	281	/* get CIs */
	282	cia = bcma_erom_get_ci(bus, eromptr);
	283	if (cia < 0) {
	284	bcma_erom_push_ent(eromptr);
	285	if (bcma_erom_is_end(bus, eromptr))
	286	return -ESPIPE;
	287	return -EILSEQ;
	288	}
	289	cib = bcma_erom_get_ci(bus, eromptr);
	290	if (cib < 0)
	291	return -EILSEQ;
	292
	293	/* parse CIs */
	294	core->id.class = (cia & SCAN_CIA_CLASS) >> SCAN_CIA_CLASS_SHIFT;
	295	core->id.id = (cia & SCAN_CIA_ID) >> SCAN_CIA_ID_SHIFT;
	296	core->id.manuf = (cia & SCAN_CIA_MANUF) >> SCAN_CIA_MANUF_SHIFT;
	297	ports[0] = (cib & SCAN_CIB_NMP) >> SCAN_CIB_NMP_SHIFT;
	298	ports[1] = (cib & SCAN_CIB_NSP) >> SCAN_CIB_NSP_SHIFT;
	299	wrappers[0] = (cib & SCAN_CIB_NMW) >> SCAN_CIB_NMW_SHIFT;
	300	wrappers[1] = (cib & SCAN_CIB_NSW) >> SCAN_CIB_NSW_SHIFT;
	301	core->id.rev = (cib & SCAN_CIB_REV) >> SCAN_CIB_REV_SHIFT;
	302
	303	if (((core->id.manuf == BCMA_MANUF_ARM) &&
	304	(core->id.id == 0xFFF)) \|\|
	305	(ports[1] == 0)) {
	306	bcma_erom_skip_component(bus, eromptr);
	307	return -ENXIO;
	308	}
	309
	310	/* check if component is a core at all */
	311	if (wrappers[0] + wrappers[1] == 0) {
e1ac4b40 RM	312	/* Some specific cores don't need wrappers */
	313	switch (core->id.id) {
	314	case BCMA_CORE_4706_MAC_GBIT_COMMON:
	315	/* Not used yet: case BCMA_CORE_OOB_ROUTER: */
	316	break;
	317	default:
	318	bcma_erom_skip_component(bus, eromptr);
	319	return -ENXIO;
	320	}
982eee67 HM	321	}
	322
	323	if (bcma_erom_is_bridge(bus, eromptr)) {
	324	bcma_erom_skip_component(bus, eromptr);
	325	return -ENXIO;
	326	}
	327
517f43e5 HM	328	if (bcma_find_core_by_index(bus, core_num)) {
	329	bcma_erom_skip_component(bus, eromptr);
	330	return -ENODEV;
	331	}
	332
	333	if (match && ((match->manuf != BCMA_ANY_MANUF &&
	334	match->manuf != core->id.manuf) \|\|
	335	(match->id != BCMA_ANY_ID && match->id != core->id.id) \|\|
	336	(match->rev != BCMA_ANY_REV && match->rev != core->id.rev) \|\|
	337	(match->class != BCMA_ANY_CLASS && match->class != core->id.class)
	338	)) {
	339	bcma_erom_skip_component(bus, eromptr);
	340	return -ENODEV;
	341	}
	342
982eee67 HM	343	/* get & parse master ports */
982eee67 HM	344	for (i = 0; i < ports[0]; i++) {
4e0d8cc1	345	s32 mst_port_d = bcma_erom_get_mst_port(bus, eromptr);
982eee67 HM	346	if (mst_port_d < 0)
	347	return -EILSEQ;
	348	}
	349
e167d9fb HM	350	/* First Slave Address Descriptor should be port 0:
	351	* the main register space for the core
	352	*/
	353	tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, 0);
fd4edf19	354	if (tmp == 0 \|\| IS_ERR_VALUE(tmp)) {
e167d9fb HM	355	/* Try again to see if it is a bridge */
	356	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	357	SCAN_ADDR_TYPE_BRIDGE, 0);
fd4edf19	358	if (tmp == 0 \|\| IS_ERR_VALUE(tmp)) {
e167d9fb HM	359	return -EILSEQ;
e167d9fb HM	360	} else {
3d9d8af3	361	bcma_info(bus, "Bridge found\n");
e167d9fb HM	362	return -ENXIO;
	363	}
	364	}
	365	core->addr = tmp;
	366
982eee67 HM	367	/* get & parse slave ports */
	368	for (i = 0; i < ports[1]; i++) {
	369	for (j = 0; ; j++) {
	370	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	371	SCAN_ADDR_TYPE_SLAVE, i);
fd4edf19	372	if (IS_ERR_VALUE(tmp)) {
982eee67 HM	373	/* no more entries for port _i_ */
	374	/* pr_debug("erom: slave port %d "
	375	* "has %d descriptors\n", i, j); */
	376	break;
	377	} else {
	378	if (i == 0 && j == 0)
e167d9fb	379	core->addr1 = tmp;
982eee67 HM	380	}
	381	}
	382	}
	383
	384	/* get & parse master wrappers */
	385	for (i = 0; i < wrappers[0]; i++) {
	386	for (j = 0; ; j++) {
	387	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	388	SCAN_ADDR_TYPE_MWRAP, i);
fd4edf19	389	if (IS_ERR_VALUE(tmp)) {
982eee67 HM	390	/* no more entries for port _i_ */
	391	/* pr_debug("erom: master wrapper %d "
	392	* "has %d descriptors\n", i, j); */
	393	break;
	394	} else {
	395	if (i == 0 && j == 0)
	396	core->wrap = tmp;
	397	}
	398	}
	399	}
	400
	401	/* get & parse slave wrappers */
	402	for (i = 0; i < wrappers[1]; i++) {
	403	u8 hack = (ports[1] == 1) ? 0 : 1;
	404	for (j = 0; ; j++) {
	405	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	406	SCAN_ADDR_TYPE_SWRAP, i + hack);
fd4edf19	407	if (IS_ERR_VALUE(tmp)) {
982eee67 HM	408	/* no more entries for port _i_ */
	409	/* pr_debug("erom: master wrapper %d "
	410	* has %d descriptors\n", i, j); */
	411	break;
	412	} else {
	413	if (wrappers[0] == 0 && !i && !j)
	414	core->wrap = tmp;
	415	}
	416	}
	417	}
ecd177c2 HM	418	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
	419	core->io_addr = ioremap_nocache(core->addr, BCMA_CORE_SIZE);
	420	if (!core->io_addr)
	421	return -ENOMEM;
	422	core->io_wrap = ioremap_nocache(core->wrap, BCMA_CORE_SIZE);
	423	if (!core->io_wrap) {
	424	iounmap(core->io_addr);
	425	return -ENOMEM;
	426	}
	427	}
982eee67 HM	428	return 0;
	429	}
	430
517f43e5	431	void bcma_init_bus(struct bcma_bus *bus)
8369ae33	432	{
8369ae33	433	s32 tmp;
f0d4724b	434	struct bcma_chipinfo *chipinfo = &(bus->chipinfo);
8369ae33	435
517f43e5 HM	436	if (bus->init_done)
	437	return;
	438
8369ae33 RM	439	INIT_LIST_HEAD(&bus->cores);
	440	bus->nr_cores = 0;
	441
	442	bcma_scan_switch_core(bus, BCMA_ADDR_BASE);
	443
	444	tmp = bcma_scan_read32(bus, 0, BCMA_CC_ID);
f0d4724b HM	445	chipinfo->id = (tmp & BCMA_CC_ID_ID) >> BCMA_CC_ID_ID_SHIFT;
	446	chipinfo->rev = (tmp & BCMA_CC_ID_REV) >> BCMA_CC_ID_REV_SHIFT;
	447	chipinfo->pkg = (tmp & BCMA_CC_ID_PKG) >> BCMA_CC_ID_PKG_SHIFT;
3d9d8af3 RM	448	bcma_info(bus, "Found chip with id 0x%04X, rev 0x%02X and package 0x%02X\n",
3d9d8af3 RM	449	chipinfo->id, chipinfo->rev, chipinfo->pkg);
f0d4724b	450
517f43e5	451	bus->init_done = true;
67a5c29e HM	452	}
	453
	454	int bcma_bus_scan(struct bcma_bus *bus)
	455	{
	456	u32 erombase;
	457	u32 __iomem eromptr, eromend;
	458
517f43e5	459	int err, core_num = 0;
67a5c29e HM	460
67a5c29e HM	461	bcma_init_bus(bus);
8369ae33 RM	462
8369ae33 RM	463	erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
ecd177c2 HM	464	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
	465	eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE);
	466	if (!eromptr)
	467	return -ENOMEM;
	468	} else {
	469	eromptr = bus->mmio;
	470	}
	471
8369ae33 RM	472	eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);
	473
	474	bcma_scan_switch_core(bus, erombase);
	475
	476	while (eromptr < eromend) {
5f2d6171	477	struct bcma_device *other_core;
8369ae33	478	struct bcma_device core = kzalloc(sizeof(core), GFP_KERNEL);
9dbf5f55 HM	479	if (!core) {
	480	err = -ENOMEM;
	481	goto out;
	482	}
8369ae33 RM	483	INIT_LIST_HEAD(&core->list);
	484	core->bus = bus;
	485
517f43e5	486	err = bcma_get_next_core(bus, &eromptr, NULL, core_num, core);
f9721ed2 JJ	487	if (err < 0) {
	488	kfree(core);
	489	if (err == -ENODEV) {
	490	core_num++;
	491	continue;
	492	} else if (err == -ENXIO) {
	493	continue;
	494	} else if (err == -ESPIPE) {
	495	break;
	496	}
9dbf5f55	497	goto out;
f9721ed2	498	}
8369ae33	499
517f43e5 HM	500	core->core_index = core_num++;
517f43e5 HM	501	bus->nr_cores++;
5f2d6171 HM	502	other_core = bcma_find_core_reverse(bus, core->id.id);
5f2d6171 HM	503	core->core_unit = (other_core == NULL) ? 0 : other_core->core_unit + 1;
517f43e5	504
3d9d8af3 RM	505	bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
	506	core->core_index, bcma_device_name(&core->id),
	507	core->id.manuf, core->id.id, core->id.rev,
	508	core->id.class);
8369ae33	509
c334e25c	510	list_add_tail(&core->list, &bus->cores);
8369ae33 RM	511	}
8369ae33 RM	512
9dbf5f55 HM	513	err = 0;
9dbf5f55 HM	514	out:
ecd177c2 HM	515	if (bus->hosttype == BCMA_HOSTTYPE_SOC)
	516	iounmap(eromptr);
	517
9dbf5f55	518	return err;
8369ae33	519	}
517f43e5 HM	520
	521	int __init bcma_bus_scan_early(struct bcma_bus *bus,
	522	struct bcma_device_id *match,
	523	struct bcma_device *core)
	524	{
	525	u32 erombase;
	526	u32 __iomem eromptr, eromend;
	527
ecd177c2 HM	528	int err = -ENODEV;
ecd177c2 HM	529	int core_num = 0;
517f43e5 HM	530
517f43e5 HM	531	erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
ecd177c2 HM	532	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
	533	eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE);
	534	if (!eromptr)
	535	return -ENOMEM;
	536	} else {
	537	eromptr = bus->mmio;
	538	}
	539
517f43e5 HM	540	eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);
	541
	542	bcma_scan_switch_core(bus, erombase);
	543
	544	while (eromptr < eromend) {
	545	memset(core, 0, sizeof(*core));
	546	INIT_LIST_HEAD(&core->list);
	547	core->bus = bus;
	548
	549	err = bcma_get_next_core(bus, &eromptr, match, core_num, core);
	550	if (err == -ENODEV) {
	551	core_num++;
	552	continue;
	553	} else if (err == -ENXIO)
	554	continue;
	555	else if (err == -ESPIPE)
	556	break;
	557	else if (err < 0)
9dbf5f55	558	goto out;
517f43e5 HM	559
	560	core->core_index = core_num++;
	561	bus->nr_cores++;
3d9d8af3 RM	562	bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
	563	core->core_index, bcma_device_name(&core->id),
	564	core->id.manuf, core->id.id, core->id.rev,
	565	core->id.class);
517f43e5	566
c334e25c	567	list_add_tail(&core->list, &bus->cores);
ecd177c2 HM	568	err = 0;
ecd177c2 HM	569	break;
517f43e5 HM	570	}
517f43e5 HM	571
9dbf5f55	572	out:
ecd177c2 HM	573	if (bus->hosttype == BCMA_HOSTTYPE_SOC)
	574	iounmap(eromptr);
	575
	576	return err;
517f43e5	577	}