[mirror_ubuntu-hirsute-kernel.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_NS_PCIEG2, "PCIe Gen 2" },
	{ BCMA_CORE_NS_DMA, "DMA" },
	{ BCMA_CORE_NS_SDIO3, "SDIO3" },
	{ BCMA_CORE_NS_USB20, "USB 2.0" },
	{ BCMA_CORE_NS_USB30, "USB 3.0" },
	{ BCMA_CORE_NS_A9JTAG, "ARM Cortex A9 JTAG" },
	{ BCMA_CORE_NS_DDR23, "Denali DDR2/DDR3 memory controller" },
	{ BCMA_CORE_NS_ROM, "ROM" },
	{ BCMA_CORE_NS_NAND, "NAND flash controller" },
	{ BCMA_CORE_NS_QSPI, "SPI flash controller" },
	{ BCMA_CORE_NS_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;
}

#define IS_ERR_VALUE_U32(x) ((x) >= (u32)-MAX_ERRNO)

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_U32(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_U32(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_U32(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_U32(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_U32(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;
		if (core->wrap) {
			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);

	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);
}

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

	int err, 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) {
		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" },
dc6be9f5 RM	35	{ BCMA_CORE_NS_PCIEG2, "PCIe Gen 2" },
	36	{ BCMA_CORE_NS_DMA, "DMA" },
	37	{ BCMA_CORE_NS_SDIO3, "SDIO3" },
	38	{ BCMA_CORE_NS_USB20, "USB 2.0" },
	39	{ BCMA_CORE_NS_USB30, "USB 3.0" },
	40	{ BCMA_CORE_NS_A9JTAG, "ARM Cortex A9 JTAG" },
	41	{ BCMA_CORE_NS_DDR23, "Denali DDR2/DDR3 memory controller" },
	42	{ BCMA_CORE_NS_ROM, "ROM" },
	43	{ BCMA_CORE_NS_NAND, "NAND flash controller" },
	44	{ BCMA_CORE_NS_QSPI, "SPI flash controller" },
	45	{ BCMA_CORE_NS_CHIPCOMMON_B, "Chipcommon B" },
bb4997a1	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
aaa2ced1 HM	272	#define IS_ERR_VALUE_U32(x) ((x) >= (u32)-MAX_ERRNO)
aaa2ced1 HM	273
982eee67	274	static int bcma_get_next_core(struct bcma_bus bus, u32 __iomem *eromptr,
517f43e5	275	struct bcma_device_id *match, int core_num,
982eee67 HM	276	struct bcma_device *core)
982eee67 HM	277	{
fd4edf19	278	u32 tmp;
982eee67 HM	279	u8 i, j;
	280	s32 cia, cib;
	281	u8 ports[2], wrappers[2];
	282
	283	/* get CIs */
	284	cia = bcma_erom_get_ci(bus, eromptr);
	285	if (cia < 0) {
	286	bcma_erom_push_ent(eromptr);
	287	if (bcma_erom_is_end(bus, eromptr))
	288	return -ESPIPE;
	289	return -EILSEQ;
	290	}
	291	cib = bcma_erom_get_ci(bus, eromptr);
	292	if (cib < 0)
	293	return -EILSEQ;
	294
	295	/* parse CIs */
	296	core->id.class = (cia & SCAN_CIA_CLASS) >> SCAN_CIA_CLASS_SHIFT;
	297	core->id.id = (cia & SCAN_CIA_ID) >> SCAN_CIA_ID_SHIFT;
	298	core->id.manuf = (cia & SCAN_CIA_MANUF) >> SCAN_CIA_MANUF_SHIFT;
	299	ports[0] = (cib & SCAN_CIB_NMP) >> SCAN_CIB_NMP_SHIFT;
	300	ports[1] = (cib & SCAN_CIB_NSP) >> SCAN_CIB_NSP_SHIFT;
	301	wrappers[0] = (cib & SCAN_CIB_NMW) >> SCAN_CIB_NMW_SHIFT;
	302	wrappers[1] = (cib & SCAN_CIB_NSW) >> SCAN_CIB_NSW_SHIFT;
	303	core->id.rev = (cib & SCAN_CIB_REV) >> SCAN_CIB_REV_SHIFT;
	304
	305	if (((core->id.manuf == BCMA_MANUF_ARM) &&
	306	(core->id.id == 0xFFF)) \|\|
	307	(ports[1] == 0)) {
	308	bcma_erom_skip_component(bus, eromptr);
	309	return -ENXIO;
	310	}
	311
	312	/* check if component is a core at all */
	313	if (wrappers[0] + wrappers[1] == 0) {
e1ac4b40 RM	314	/* Some specific cores don't need wrappers */
	315	switch (core->id.id) {
	316	case BCMA_CORE_4706_MAC_GBIT_COMMON:
	317	/* Not used yet: case BCMA_CORE_OOB_ROUTER: */
	318	break;
	319	default:
	320	bcma_erom_skip_component(bus, eromptr);
	321	return -ENXIO;
	322	}
982eee67 HM	323	}
	324
	325	if (bcma_erom_is_bridge(bus, eromptr)) {
	326	bcma_erom_skip_component(bus, eromptr);
	327	return -ENXIO;
	328	}
	329
517f43e5 HM	330	if (bcma_find_core_by_index(bus, core_num)) {
	331	bcma_erom_skip_component(bus, eromptr);
	332	return -ENODEV;
	333	}
	334
	335	if (match && ((match->manuf != BCMA_ANY_MANUF &&
	336	match->manuf != core->id.manuf) \|\|
	337	(match->id != BCMA_ANY_ID && match->id != core->id.id) \|\|
	338	(match->rev != BCMA_ANY_REV && match->rev != core->id.rev) \|\|
	339	(match->class != BCMA_ANY_CLASS && match->class != core->id.class)
	340	)) {
	341	bcma_erom_skip_component(bus, eromptr);
	342	return -ENODEV;
	343	}
	344
982eee67 HM	345	/* get & parse master ports */
982eee67 HM	346	for (i = 0; i < ports[0]; i++) {
4e0d8cc1	347	s32 mst_port_d = bcma_erom_get_mst_port(bus, eromptr);
982eee67 HM	348	if (mst_port_d < 0)
	349	return -EILSEQ;
	350	}
	351
e167d9fb HM	352	/* First Slave Address Descriptor should be port 0:
	353	* the main register space for the core
	354	*/
	355	tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, 0);
aaa2ced1	356	if (tmp == 0 \|\| IS_ERR_VALUE_U32(tmp)) {
e167d9fb HM	357	/* Try again to see if it is a bridge */
	358	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	359	SCAN_ADDR_TYPE_BRIDGE, 0);
aaa2ced1	360	if (tmp == 0 \|\| IS_ERR_VALUE_U32(tmp)) {
e167d9fb HM	361	return -EILSEQ;
e167d9fb HM	362	} else {
3d9d8af3	363	bcma_info(bus, "Bridge found\n");
e167d9fb HM	364	return -ENXIO;
	365	}
	366	}
	367	core->addr = tmp;
	368
982eee67 HM	369	/* get & parse slave ports */
	370	for (i = 0; i < ports[1]; i++) {
	371	for (j = 0; ; j++) {
	372	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	373	SCAN_ADDR_TYPE_SLAVE, i);
aaa2ced1	374	if (IS_ERR_VALUE_U32(tmp)) {
982eee67 HM	375	/* no more entries for port _i_ */
	376	/* pr_debug("erom: slave port %d "
	377	* "has %d descriptors\n", i, j); */
	378	break;
	379	} else {
	380	if (i == 0 && j == 0)
e167d9fb	381	core->addr1 = tmp;
982eee67 HM	382	}
	383	}
	384	}
	385
	386	/* get & parse master wrappers */
	387	for (i = 0; i < wrappers[0]; i++) {
	388	for (j = 0; ; j++) {
	389	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	390	SCAN_ADDR_TYPE_MWRAP, i);
aaa2ced1	391	if (IS_ERR_VALUE_U32(tmp)) {
982eee67 HM	392	/* no more entries for port _i_ */
	393	/* pr_debug("erom: master wrapper %d "
	394	* "has %d descriptors\n", i, j); */
	395	break;
	396	} else {
	397	if (i == 0 && j == 0)
	398	core->wrap = tmp;
	399	}
	400	}
	401	}
	402
	403	/* get & parse slave wrappers */
	404	for (i = 0; i < wrappers[1]; i++) {
	405	u8 hack = (ports[1] == 1) ? 0 : 1;
	406	for (j = 0; ; j++) {
	407	tmp = bcma_erom_get_addr_desc(bus, eromptr,
	408	SCAN_ADDR_TYPE_SWRAP, i + hack);
aaa2ced1	409	if (IS_ERR_VALUE_U32(tmp)) {
982eee67 HM	410	/* no more entries for port _i_ */
	411	/* pr_debug("erom: master wrapper %d "
	412	* has %d descriptors\n", i, j); */
	413	break;
	414	} else {
	415	if (wrappers[0] == 0 && !i && !j)
	416	core->wrap = tmp;
	417	}
	418	}
	419	}
ecd177c2 HM	420	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
	421	core->io_addr = ioremap_nocache(core->addr, BCMA_CORE_SIZE);
	422	if (!core->io_addr)
	423	return -ENOMEM;
ecf47e9b HM	424	if (core->wrap) {
	425	core->io_wrap = ioremap_nocache(core->wrap,
	426	BCMA_CORE_SIZE);
	427	if (!core->io_wrap) {
	428	iounmap(core->io_addr);
	429	return -ENOMEM;
	430	}
ecd177c2 HM	431	}
ecd177c2 HM	432	}
982eee67 HM	433	return 0;
	434	}
	435
517f43e5	436	void bcma_init_bus(struct bcma_bus *bus)
8369ae33	437	{
8369ae33	438	s32 tmp;
f0d4724b	439	struct bcma_chipinfo *chipinfo = &(bus->chipinfo);
8369ae33	440
8369ae33 RM	441	INIT_LIST_HEAD(&bus->cores);
	442	bus->nr_cores = 0;
	443
	444	bcma_scan_switch_core(bus, BCMA_ADDR_BASE);
	445
	446	tmp = bcma_scan_read32(bus, 0, BCMA_CC_ID);
f0d4724b HM	447	chipinfo->id = (tmp & BCMA_CC_ID_ID) >> BCMA_CC_ID_ID_SHIFT;
	448	chipinfo->rev = (tmp & BCMA_CC_ID_REV) >> BCMA_CC_ID_REV_SHIFT;
	449	chipinfo->pkg = (tmp & BCMA_CC_ID_PKG) >> BCMA_CC_ID_PKG_SHIFT;
3d9d8af3 RM	450	bcma_info(bus, "Found chip with id 0x%04X, rev 0x%02X and package 0x%02X\n",
3d9d8af3 RM	451	chipinfo->id, chipinfo->rev, chipinfo->pkg);
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	460
8369ae33	461	erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
ecd177c2 HM	462	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
	463	eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE);
	464	if (!eromptr)
	465	return -ENOMEM;
	466	} else {
	467	eromptr = bus->mmio;
	468	}
	469
8369ae33 RM	470	eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);
	471
	472	bcma_scan_switch_core(bus, erombase);
	473
	474	while (eromptr < eromend) {
5f2d6171	475	struct bcma_device *other_core;
8369ae33	476	struct bcma_device core = kzalloc(sizeof(core), GFP_KERNEL);
9dbf5f55 HM	477	if (!core) {
	478	err = -ENOMEM;
	479	goto out;
	480	}
8369ae33 RM	481	INIT_LIST_HEAD(&core->list);
	482	core->bus = bus;
	483
517f43e5	484	err = bcma_get_next_core(bus, &eromptr, NULL, core_num, core);
f9721ed2 JJ	485	if (err < 0) {
	486	kfree(core);
	487	if (err == -ENODEV) {
	488	core_num++;
	489	continue;
	490	} else if (err == -ENXIO) {
	491	continue;
	492	} else if (err == -ESPIPE) {
	493	break;
	494	}
9dbf5f55	495	goto out;
f9721ed2	496	}
8369ae33	497
517f43e5 HM	498	core->core_index = core_num++;
517f43e5 HM	499	bus->nr_cores++;
5f2d6171 HM	500	other_core = bcma_find_core_reverse(bus, core->id.id);
5f2d6171 HM	501	core->core_unit = (other_core == NULL) ? 0 : other_core->core_unit + 1;
517f43e5	502
3d9d8af3 RM	503	bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
	504	core->core_index, bcma_device_name(&core->id),
	505	core->id.manuf, core->id.id, core->id.rev,
	506	core->id.class);
8369ae33	507
c334e25c	508	list_add_tail(&core->list, &bus->cores);
8369ae33 RM	509	}
8369ae33 RM	510
9dbf5f55 HM	511	err = 0;
9dbf5f55 HM	512	out:
ecd177c2 HM	513	if (bus->hosttype == BCMA_HOSTTYPE_SOC)
	514	iounmap(eromptr);
	515
9dbf5f55	516	return err;
8369ae33	517	}
517f43e5 HM	518
	519	int __init bcma_bus_scan_early(struct bcma_bus *bus,
	520	struct bcma_device_id *match,
	521	struct bcma_device *core)
	522	{
	523	u32 erombase;
	524	u32 __iomem eromptr, eromend;
	525
ecd177c2 HM	526	int err = -ENODEV;
ecd177c2 HM	527	int core_num = 0;
517f43e5 HM	528
517f43e5 HM	529	erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
ecd177c2 HM	530	if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
	531	eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE);
	532	if (!eromptr)
	533	return -ENOMEM;
	534	} else {
	535	eromptr = bus->mmio;
	536	}
	537
517f43e5 HM	538	eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);
	539
	540	bcma_scan_switch_core(bus, erombase);
	541
	542	while (eromptr < eromend) {
	543	memset(core, 0, sizeof(*core));
	544	INIT_LIST_HEAD(&core->list);
	545	core->bus = bus;
	546
	547	err = bcma_get_next_core(bus, &eromptr, match, core_num, core);
	548	if (err == -ENODEV) {
	549	core_num++;
	550	continue;
	551	} else if (err == -ENXIO)
	552	continue;
	553	else if (err == -ESPIPE)
	554	break;
	555	else if (err < 0)
9dbf5f55	556	goto out;
517f43e5 HM	557
	558	core->core_index = core_num++;
	559	bus->nr_cores++;
3d9d8af3 RM	560	bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
	561	core->core_index, bcma_device_name(&core->id),
	562	core->id.manuf, core->id.id, core->id.rev,
	563	core->id.class);
517f43e5	564
c334e25c	565	list_add_tail(&core->list, &bus->cores);
ecd177c2 HM	566	err = 0;
ecd177c2 HM	567	break;
517f43e5 HM	568	}
517f43e5 HM	569
9dbf5f55	570	out:
ecd177c2 HM	571	if (bus->hosttype == BCMA_HOSTTYPE_SOC)
	572	iounmap(eromptr);
	573
	574	return err;
517f43e5	575	}