[linux-2.6-block.git] / drivers / ssb / driver_mipscore.c

/*
 * Sonics Silicon Backplane
 * Broadcom MIPS core driver
 *
 * Copyright 2005, Broadcom Corporation
 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
 *
 * Licensed under the GNU/GPL. See COPYING for details.
 */

#include "ssb_private.h"

#include <linux/ssb/ssb.h>

#include <linux/mtd/physmap.h>
#include <linux/serial.h>
#include <linux/serial_core.h>
#include <linux/serial_reg.h>
#include <linux/time.h>
#ifdef CONFIG_BCM47XX
#include <linux/bcm47xx_nvram.h>
#endif

static const char * const part_probes[] = { "bcm47xxpart", NULL };

static struct physmap_flash_data ssb_pflash_data = {
	.part_probe_types	= part_probes,
};

static struct resource ssb_pflash_resource = {
	.name	= "ssb_pflash",
	.flags  = IORESOURCE_MEM,
};

struct platform_device ssb_pflash_dev = {
	.name		= "physmap-flash",
	.dev		= {
		.platform_data  = &ssb_pflash_data,
	},
	.resource	= &ssb_pflash_resource,
	.num_resources	= 1,
};

static inline u32 mips_read32(struct ssb_mipscore *mcore,
			      u16 offset)
{
	return ssb_read32(mcore->dev, offset);
}

static inline void mips_write32(struct ssb_mipscore *mcore,
				u16 offset,
				u32 value)
{
	ssb_write32(mcore->dev, offset, value);
}

static const u32 ipsflag_irq_mask[] = {
	0,
	SSB_IPSFLAG_IRQ1,
	SSB_IPSFLAG_IRQ2,
	SSB_IPSFLAG_IRQ3,
	SSB_IPSFLAG_IRQ4,
};

static const u32 ipsflag_irq_shift[] = {
	0,
	SSB_IPSFLAG_IRQ1_SHIFT,
	SSB_IPSFLAG_IRQ2_SHIFT,
	SSB_IPSFLAG_IRQ3_SHIFT,
	SSB_IPSFLAG_IRQ4_SHIFT,
};

static inline u32 ssb_irqflag(struct ssb_device *dev)
{
	u32 tpsflag = ssb_read32(dev, SSB_TPSFLAG);
	if (tpsflag)
		return ssb_read32(dev, SSB_TPSFLAG) & SSB_TPSFLAG_BPFLAG;
	else
		/* not irq supported */
		return 0x3f;
}

static struct ssb_device *find_device(struct ssb_device *rdev, int irqflag)
{
	struct ssb_bus *bus = rdev->bus;
	int i;
	for (i = 0; i < bus->nr_devices; i++) {
		struct ssb_device *dev;
		dev = &(bus->devices[i]);
		if (ssb_irqflag(dev) == irqflag)
			return dev;
	}
	return NULL;
}

/* Get the MIPS IRQ assignment for a specified device.
 * If unassigned, 0 is returned.
 * If disabled, 5 is returned.
 * If not supported, 6 is returned.
 */
unsigned int ssb_mips_irq(struct ssb_device *dev)
{
	struct ssb_bus *bus = dev->bus;
	struct ssb_device *mdev = bus->mipscore.dev;
	u32 irqflag;
	u32 ipsflag;
	u32 tmp;
	unsigned int irq;

	irqflag = ssb_irqflag(dev);
	if (irqflag == 0x3f)
		return 6;
	ipsflag = ssb_read32(bus->mipscore.dev, SSB_IPSFLAG);
	for (irq = 1; irq <= 4; irq++) {
		tmp = ((ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq]);
		if (tmp == irqflag)
			break;
	}
	if (irq	== 5) {
		if ((1 << irqflag) & ssb_read32(mdev, SSB_INTVEC))
			irq = 0;
	}

	return irq;
}

static void clear_irq(struct ssb_bus *bus, unsigned int irq)
{
	struct ssb_device *dev = bus->mipscore.dev;

	/* Clear the IRQ in the MIPScore backplane registers */
	if (irq == 0) {
		ssb_write32(dev, SSB_INTVEC, 0);
	} else {
		ssb_write32(dev, SSB_IPSFLAG,
			    ssb_read32(dev, SSB_IPSFLAG) |
			    ipsflag_irq_mask[irq]);
	}
}

static void set_irq(struct ssb_device *dev, unsigned int irq)
{
	unsigned int oldirq = ssb_mips_irq(dev);
	struct ssb_bus *bus = dev->bus;
	struct ssb_device *mdev = bus->mipscore.dev;
	u32 irqflag = ssb_irqflag(dev);

	BUG_ON(oldirq == 6);

	dev->irq = irq + 2;

	/* clear the old irq */
	if (oldirq == 0)
		ssb_write32(mdev, SSB_INTVEC, (~(1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
	else if (oldirq != 5)
		clear_irq(bus, oldirq);

	/* assign the new one */
	if (irq == 0) {
		ssb_write32(mdev, SSB_INTVEC, ((1 << irqflag) | ssb_read32(mdev, SSB_INTVEC)));
	} else {
		u32 ipsflag = ssb_read32(mdev, SSB_IPSFLAG);
		if ((ipsflag & ipsflag_irq_mask[irq]) != ipsflag_irq_mask[irq]) {
			u32 oldipsflag = (ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq];
			struct ssb_device *olddev = find_device(dev, oldipsflag);
			if (olddev)
				set_irq(olddev, 0);
		}
		irqflag <<= ipsflag_irq_shift[irq];
		irqflag |= (ipsflag & ~ipsflag_irq_mask[irq]);
		ssb_write32(mdev, SSB_IPSFLAG, irqflag);
	}
	dev_dbg(dev->dev, "set_irq: core 0x%04x, irq %d => %d\n",
		dev->id.coreid, oldirq+2, irq+2);
}

static void print_irq(struct ssb_device *dev, unsigned int irq)
{
	static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
	dev_dbg(dev->dev,
		"core 0x%04x, irq : %s%s %s%s %s%s %s%s %s%s %s%s %s%s\n",
		dev->id.coreid,
		irq_name[0], irq == 0 ? "*" : " ",
		irq_name[1], irq == 1 ? "*" : " ",
		irq_name[2], irq == 2 ? "*" : " ",
		irq_name[3], irq == 3 ? "*" : " ",
		irq_name[4], irq == 4 ? "*" : " ",
		irq_name[5], irq == 5 ? "*" : " ",
		irq_name[6], irq == 6 ? "*" : " ");
}

static void dump_irq(struct ssb_bus *bus)
{
	int i;
	for (i = 0; i < bus->nr_devices; i++) {
		struct ssb_device *dev;
		dev = &(bus->devices[i]);
		print_irq(dev, ssb_mips_irq(dev));
	}
}

static void ssb_mips_serial_init(struct ssb_mipscore *mcore)
{
	struct ssb_bus *bus = mcore->dev->bus;

	if (ssb_extif_available(&bus->extif))
		mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
	else if (ssb_chipco_available(&bus->chipco))
		mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
	else
		mcore->nr_serial_ports = 0;
}

static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
{
	struct ssb_bus *bus = mcore->dev->bus;
	struct ssb_sflash *sflash = &mcore->sflash;
	struct ssb_pflash *pflash = &mcore->pflash;

	/* When there is no chipcommon on the bus there is 4MB flash */
	if (!ssb_chipco_available(&bus->chipco)) {
		pflash->present = true;
		pflash->buswidth = 2;
		pflash->window = SSB_FLASH1;
		pflash->window_size = SSB_FLASH1_SZ;
		goto ssb_pflash;
	}

	/* There is ChipCommon, so use it to read info about flash */
	switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) {
	case SSB_CHIPCO_FLASHT_STSER:
	case SSB_CHIPCO_FLASHT_ATSER:
		dev_dbg(mcore->dev->dev, "Found serial flash\n");
		ssb_sflash_init(&bus->chipco);
		break;
	case SSB_CHIPCO_FLASHT_PARA:
		dev_dbg(mcore->dev->dev, "Found parallel flash\n");
		pflash->present = true;
		pflash->window = SSB_FLASH2;
		pflash->window_size = SSB_FLASH2_SZ;
		if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
		               & SSB_CHIPCO_CFG_DS16) == 0)
			pflash->buswidth = 1;
		else
			pflash->buswidth = 2;
		break;
	}

ssb_pflash:
	if (sflash->present) {
#ifdef CONFIG_BCM47XX
		bcm47xx_nvram_init_from_mem(sflash->window, sflash->size);
#endif
	} else if (pflash->present) {
#ifdef CONFIG_BCM47XX
		bcm47xx_nvram_init_from_mem(pflash->window, pflash->window_size);
#endif

		ssb_pflash_data.width = pflash->buswidth;
		ssb_pflash_resource.start = pflash->window;
		ssb_pflash_resource.end = pflash->window + pflash->window_size;
	}
}

u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
{
	struct ssb_bus *bus = mcore->dev->bus;
	u32 pll_type, n, m, rate = 0;

	if (bus->chipco.capabilities & SSB_CHIPCO_CAP_PMU)
		return ssb_pmu_get_cpu_clock(&bus->chipco);

	if (ssb_extif_available(&bus->extif)) {
		ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
	} else if (ssb_chipco_available(&bus->chipco)) {
		ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
	} else
		return 0;

	if ((pll_type == SSB_PLLTYPE_5) || (bus->chip_id == 0x5365)) {
		rate = 200000000;
	} else {
		rate = ssb_calc_clock_rate(pll_type, n, m);
	}

	if (pll_type == SSB_PLLTYPE_6) {
		rate *= 2;
	}

	return rate;
}

void ssb_mipscore_init(struct ssb_mipscore *mcore)
{
	struct ssb_bus *bus;
	struct ssb_device *dev;
	unsigned long hz, ns;
	unsigned int irq, i;

	if (!mcore->dev)
		return; /* We don't have a MIPS core */

	dev_dbg(mcore->dev->dev, "Initializing MIPS core...\n");

	bus = mcore->dev->bus;
	hz = ssb_clockspeed(bus);
	if (!hz)
		hz = 100000000;
	ns = 1000000000 / hz;

	if (ssb_extif_available(&bus->extif))
		ssb_extif_timing_init(&bus->extif, ns);
	else if (ssb_chipco_available(&bus->chipco))
		ssb_chipco_timing_init(&bus->chipco, ns);

	/* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
	for (irq = 2, i = 0; i < bus->nr_devices; i++) {
		int mips_irq;
		dev = &(bus->devices[i]);
		mips_irq = ssb_mips_irq(dev);
		if (mips_irq > 4)
			dev->irq = 0;
		else
			dev->irq = mips_irq + 2;
		if (dev->irq > 5)
			continue;
		switch (dev->id.coreid) {
		case SSB_DEV_USB11_HOST:
			/* shouldn't need a separate irq line for non-4710, most of them have a proper
			 * external usb controller on the pci */
			if ((bus->chip_id == 0x4710) && (irq <= 4)) {
				set_irq(dev, irq++);
			}
			break;
		case SSB_DEV_PCI:
		case SSB_DEV_ETHERNET:
		case SSB_DEV_ETHERNET_GBIT:
		case SSB_DEV_80211:
		case SSB_DEV_USB20_HOST:
			/* These devices get their own IRQ line if available, the rest goes on IRQ0 */
			if (irq <= 4) {
				set_irq(dev, irq++);
				break;
			}
			/* fallthrough */
		case SSB_DEV_EXTIF:
			set_irq(dev, 0);
			break;
		}
	}
	dev_dbg(mcore->dev->dev, "after irq reconfiguration\n");
	dump_irq(bus);

	ssb_mips_serial_init(mcore);
	ssb_mips_flash_detect(mcore);
}
Commit	Line	Data
61e115a5 MB	1	/*
	2	* Sonics Silicon Backplane
	3	* Broadcom MIPS core driver
	4	*
	5	* Copyright 2005, Broadcom Corporation
eb032b98	6	* Copyright 2006, 2007, Michael Buesch <m@bues.ch>
61e115a5 MB	7	*
	8	* Licensed under the GNU/GPL. See COPYING for details.
	9	*/
	10
b8b6069c MB	11	#include "ssb_private.h"
b8b6069c MB	12
61e115a5 MB	13	#include <linux/ssb/ssb.h>
61e115a5 MB	14
c7a4a9e3	15	#include <linux/mtd/physmap.h>
61e115a5 MB	16	#include <linux/serial.h>
	17	#include <linux/serial_core.h>
	18	#include <linux/serial_reg.h>
	19	#include <linux/time.h>
21400f25	20	#ifdef CONFIG_BCM47XX
138173d4	21	#include <linux/bcm47xx_nvram.h>
21400f25	22	#endif
61e115a5	23
255e9fd4	24	static const char * const part_probes[] = { "bcm47xxpart", NULL };
c7a4a9e3 RM	25
	26	static struct physmap_flash_data ssb_pflash_data = {
	27	.part_probe_types = part_probes,
	28	};
	29
	30	static struct resource ssb_pflash_resource = {
	31	.name = "ssb_pflash",
	32	.flags = IORESOURCE_MEM,
	33	};
	34
	35	struct platform_device ssb_pflash_dev = {
	36	.name = "physmap-flash",
	37	.dev = {
	38	.platform_data = &ssb_pflash_data,
	39	},
	40	.resource = &ssb_pflash_resource,
	41	.num_resources = 1,
	42	};
61e115a5 MB	43
	44	static inline u32 mips_read32(struct ssb_mipscore *mcore,
	45	u16 offset)
	46	{
	47	return ssb_read32(mcore->dev, offset);
	48	}
	49
	50	static inline void mips_write32(struct ssb_mipscore *mcore,
	51	u16 offset,
	52	u32 value)
	53	{
	54	ssb_write32(mcore->dev, offset, value);
	55	}
	56
	57	static const u32 ipsflag_irq_mask[] = {
	58	0,
	59	SSB_IPSFLAG_IRQ1,
	60	SSB_IPSFLAG_IRQ2,
	61	SSB_IPSFLAG_IRQ3,
	62	SSB_IPSFLAG_IRQ4,
	63	};
	64
	65	static const u32 ipsflag_irq_shift[] = {
	66	0,
	67	SSB_IPSFLAG_IRQ1_SHIFT,
	68	SSB_IPSFLAG_IRQ2_SHIFT,
	69	SSB_IPSFLAG_IRQ3_SHIFT,
	70	SSB_IPSFLAG_IRQ4_SHIFT,
	71	};
	72
	73	static inline u32 ssb_irqflag(struct ssb_device *dev)
	74	{
ea4bbfd0	75	u32 tpsflag = ssb_read32(dev, SSB_TPSFLAG);
	76	if (tpsflag)
	77	return ssb_read32(dev, SSB_TPSFLAG) & SSB_TPSFLAG_BPFLAG;
	78	else
	79	/* not irq supported */
	80	return 0x3f;
	81	}
	82
	83	static struct ssb_device find_device(struct ssb_device rdev, int irqflag)
	84	{
	85	struct ssb_bus *bus = rdev->bus;
	86	int i;
	87	for (i = 0; i < bus->nr_devices; i++) {
	88	struct ssb_device *dev;
	89	dev = &(bus->devices[i]);
	90	if (ssb_irqflag(dev) == irqflag)
	91	return dev;
	92	}
	93	return NULL;
61e115a5 MB	94	}
	95
	96	/* Get the MIPS IRQ assignment for a specified device.
	97	* If unassigned, 0 is returned.
ea4bbfd0	98	* If disabled, 5 is returned.
ea4bbfd0	99	* If not supported, 6 is returned.
61e115a5 MB	100	*/
	101	unsigned int ssb_mips_irq(struct ssb_device *dev)
	102	{
	103	struct ssb_bus *bus = dev->bus;
ea4bbfd0	104	struct ssb_device *mdev = bus->mipscore.dev;
61e115a5 MB	105	u32 irqflag;
	106	u32 ipsflag;
	107	u32 tmp;
	108	unsigned int irq;
	109
	110	irqflag = ssb_irqflag(dev);
ea4bbfd0	111	if (irqflag == 0x3f)
ea4bbfd0	112	return 6;
61e115a5 MB	113	ipsflag = ssb_read32(bus->mipscore.dev, SSB_IPSFLAG);
	114	for (irq = 1; irq <= 4; irq++) {
	115	tmp = ((ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq]);
	116	if (tmp == irqflag)
	117	break;
	118	}
ea4bbfd0	119	if (irq == 5) {
	120	if ((1 << irqflag) & ssb_read32(mdev, SSB_INTVEC))
	121	irq = 0;
	122	}
61e115a5 MB	123
	124	return irq;
	125	}
	126
	127	static void clear_irq(struct ssb_bus *bus, unsigned int irq)
	128	{
	129	struct ssb_device *dev = bus->mipscore.dev;
	130
	131	/* Clear the IRQ in the MIPScore backplane registers */
	132	if (irq == 0) {
	133	ssb_write32(dev, SSB_INTVEC, 0);
	134	} else {
	135	ssb_write32(dev, SSB_IPSFLAG,
	136	ssb_read32(dev, SSB_IPSFLAG) \|
	137	ipsflag_irq_mask[irq]);
	138	}
	139	}
	140
	141	static void set_irq(struct ssb_device *dev, unsigned int irq)
	142	{
	143	unsigned int oldirq = ssb_mips_irq(dev);
	144	struct ssb_bus *bus = dev->bus;
	145	struct ssb_device *mdev = bus->mipscore.dev;
	146	u32 irqflag = ssb_irqflag(dev);
	147
ea4bbfd0	148	BUG_ON(oldirq == 6);
ea4bbfd0	149
61e115a5 MB	150	dev->irq = irq + 2;
61e115a5 MB	151
61e115a5 MB	152	/* clear the old irq */
	153	if (oldirq == 0)
	154	ssb_write32(mdev, SSB_INTVEC, (~(1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
ea4bbfd0	155	else if (oldirq != 5)
61e115a5 MB	156	clear_irq(bus, oldirq);
	157
	158	/* assign the new one */
2633da23 MB	159	if (irq == 0) {
	160	ssb_write32(mdev, SSB_INTVEC, ((1 << irqflag) \| ssb_read32(mdev, SSB_INTVEC)));
	161	} else {
ea4bbfd0	162	u32 ipsflag = ssb_read32(mdev, SSB_IPSFLAG);
	163	if ((ipsflag & ipsflag_irq_mask[irq]) != ipsflag_irq_mask[irq]) {
	164	u32 oldipsflag = (ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq];
	165	struct ssb_device *olddev = find_device(dev, oldipsflag);
	166	if (olddev)
	167	set_irq(olddev, 0);
	168	}
2633da23	169	irqflag <<= ipsflag_irq_shift[irq];
ea4bbfd0	170	irqflag \|= (ipsflag & ~ipsflag_irq_mask[irq]);
2633da23 MB	171	ssb_write32(mdev, SSB_IPSFLAG, irqflag);
2633da23 MB	172	}
b8b6069c	173	dev_dbg(dev->dev, "set_irq: core 0x%04x, irq %d => %d\n",
33a606ac	174	dev->id.coreid, oldirq+2, irq+2);
ea4bbfd0	175	}
	176
	177	static void print_irq(struct ssb_device *dev, unsigned int irq)
	178	{
ea4bbfd0	179	static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
b8b6069c MB	180	dev_dbg(dev->dev,
b8b6069c MB	181	"core 0x%04x, irq : %s%s %s%s %s%s %s%s %s%s %s%s %s%s\n",
33a606ac JP	182	dev->id.coreid,
	183	irq_name[0], irq == 0 ? "*" : " ",
	184	irq_name[1], irq == 1 ? "*" : " ",
	185	irq_name[2], irq == 2 ? "*" : " ",
	186	irq_name[3], irq == 3 ? "*" : " ",
	187	irq_name[4], irq == 4 ? "*" : " ",
	188	irq_name[5], irq == 5 ? "*" : " ",
	189	irq_name[6], irq == 6 ? "*" : " ");
ea4bbfd0	190	}
	191
	192	static void dump_irq(struct ssb_bus *bus)
	193	{
	194	int i;
	195	for (i = 0; i < bus->nr_devices; i++) {
	196	struct ssb_device *dev;
	197	dev = &(bus->devices[i]);
	198	print_irq(dev, ssb_mips_irq(dev));
	199	}
61e115a5 MB	200	}
	201
	202	static void ssb_mips_serial_init(struct ssb_mipscore *mcore)
	203	{
	204	struct ssb_bus *bus = mcore->dev->bus;
	205
0362063b	206	if (ssb_extif_available(&bus->extif))
61e115a5	207	mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
0362063b	208	else if (ssb_chipco_available(&bus->chipco))
61e115a5 MB	209	mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
	210	else
	211	mcore->nr_serial_ports = 0;
	212	}
	213
	214	static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
	215	{
	216	struct ssb_bus *bus = mcore->dev->bus;
21400f25	217	struct ssb_sflash *sflash = &mcore->sflash;
f1ab57e3	218	struct ssb_pflash *pflash = &mcore->pflash;
61e115a5	219
902d9e0f	220	/* When there is no chipcommon on the bus there is 4MB flash */
0362063b	221	if (!ssb_chipco_available(&bus->chipco)) {
f1ab57e3 RM	222	pflash->present = true;
	223	pflash->buswidth = 2;
	224	pflash->window = SSB_FLASH1;
	225	pflash->window_size = SSB_FLASH1_SZ;
c7a4a9e3	226	goto ssb_pflash;
902d9e0f RM	227	}
	228
	229	/* There is ChipCommon, so use it to read info about flash */
	230	switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) {
	231	case SSB_CHIPCO_FLASHT_STSER:
	232	case SSB_CHIPCO_FLASHT_ATSER:
b8b6069c	233	dev_dbg(mcore->dev->dev, "Found serial flash\n");
72a525cb	234	ssb_sflash_init(&bus->chipco);
902d9e0f RM	235	break;
902d9e0f RM	236	case SSB_CHIPCO_FLASHT_PARA:
b8b6069c	237	dev_dbg(mcore->dev->dev, "Found parallel flash\n");
f1ab57e3 RM	238	pflash->present = true;
	239	pflash->window = SSB_FLASH2;
	240	pflash->window_size = SSB_FLASH2_SZ;
61e115a5 MB	241	if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
61e115a5 MB	242	& SSB_CHIPCO_CFG_DS16) == 0)
f1ab57e3	243	pflash->buswidth = 1;
902d9e0f	244	else
f1ab57e3	245	pflash->buswidth = 2;
902d9e0f	246	break;
61e115a5	247	}
c7a4a9e3 RM	248
c7a4a9e3 RM	249	ssb_pflash:
21400f25 RM	250	if (sflash->present) {
	251	#ifdef CONFIG_BCM47XX
	252	bcm47xx_nvram_init_from_mem(sflash->window, sflash->size);
	253	#endif
	254	} else if (pflash->present) {
	255	#ifdef CONFIG_BCM47XX
	256	bcm47xx_nvram_init_from_mem(pflash->window, pflash->window_size);
	257	#endif
	258
c7a4a9e3 RM	259	ssb_pflash_data.width = pflash->buswidth;
	260	ssb_pflash_resource.start = pflash->window;
	261	ssb_pflash_resource.end = pflash->window + pflash->window_size;
	262	}
61e115a5 MB	263	}
	264
	265	u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
	266	{
	267	struct ssb_bus *bus = mcore->dev->bus;
	268	u32 pll_type, n, m, rate = 0;
	269
d486a5b4 HM	270	if (bus->chipco.capabilities & SSB_CHIPCO_CAP_PMU)
	271	return ssb_pmu_get_cpu_clock(&bus->chipco);
	272
0362063b	273	if (ssb_extif_available(&bus->extif)) {
61e115a5	274	ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
0362063b	275	} else if (ssb_chipco_available(&bus->chipco)) {
61e115a5 MB	276	ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
	277	} else
	278	return 0;
	279
	280	if ((pll_type == SSB_PLLTYPE_5) \|\| (bus->chip_id == 0x5365)) {
	281	rate = 200000000;
	282	} else {
	283	rate = ssb_calc_clock_rate(pll_type, n, m);
	284	}
	285
	286	if (pll_type == SSB_PLLTYPE_6) {
	287	rate *= 2;
	288	}
	289
	290	return rate;
	291	}
	292
	293	void ssb_mipscore_init(struct ssb_mipscore *mcore)
	294	{
7007d00c	295	struct ssb_bus *bus;
61e115a5 MB	296	struct ssb_device *dev;
	297	unsigned long hz, ns;
	298	unsigned int irq, i;
	299
	300	if (!mcore->dev)
	301	return; /* We don't have a MIPS core */
	302
b8b6069c	303	dev_dbg(mcore->dev->dev, "Initializing MIPS core...\n");
61e115a5	304
7007d00c	305	bus = mcore->dev->bus;
61e115a5 MB	306	hz = ssb_clockspeed(bus);
	307	if (!hz)
	308	hz = 100000000;
	309	ns = 1000000000 / hz;
	310
0362063b	311	if (ssb_extif_available(&bus->extif))
61e115a5	312	ssb_extif_timing_init(&bus->extif, ns);
0362063b	313	else if (ssb_chipco_available(&bus->chipco))
61e115a5 MB	314	ssb_chipco_timing_init(&bus->chipco, ns);
	315
	316	/* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
	317	for (irq = 2, i = 0; i < bus->nr_devices; i++) {
ea4bbfd0	318	int mips_irq;
61e115a5	319	dev = &(bus->devices[i]);
ea4bbfd0	320	mips_irq = ssb_mips_irq(dev);
	321	if (mips_irq > 4)
	322	dev->irq = 0;
	323	else
	324	dev->irq = mips_irq + 2;
	325	if (dev->irq > 5)
	326	continue;
61e115a5 MB	327	switch (dev->id.coreid) {
	328	case SSB_DEV_USB11_HOST:
	329	/* shouldn't need a separate irq line for non-4710, most of them have a proper
	330	* external usb controller on the pci */
	331	if ((bus->chip_id == 0x4710) && (irq <= 4)) {
	332	set_irq(dev, irq++);
61e115a5	333	}
ea4bbfd0	334	break;
61e115a5 MB	335	case SSB_DEV_PCI:
61e115a5 MB	336	case SSB_DEV_ETHERNET:
aab547ce	337	case SSB_DEV_ETHERNET_GBIT:
61e115a5 MB	338	case SSB_DEV_80211:
	339	case SSB_DEV_USB20_HOST:
	340	/* These devices get their own IRQ line if available, the rest goes on IRQ0 */
	341	if (irq <= 4) {
	342	set_irq(dev, irq++);
	343	break;
	344	}
83e34f03 JF	345	/* fallthrough */
	346	case SSB_DEV_EXTIF:
	347	set_irq(dev, 0);
	348	break;
61e115a5 MB	349	}
61e115a5 MB	350	}
b8b6069c	351	dev_dbg(mcore->dev->dev, "after irq reconfiguration\n");
ea4bbfd0	352	dump_irq(bus);
61e115a5 MB	353
	354	ssb_mips_serial_init(mcore);
	355	ssb_mips_flash_detect(mcore);
	356	}