121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens/*
221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Broadcom specific AMBA
321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Broadcom MIPS32 74K core driver
421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens *
521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Copyright 2009, Broadcom Corporation
621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de>
721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Copyright 2010, Bernhard Loos <bernhardloos@googlemail.com>
821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Copyright 2011, Hauke Mehrtens <hauke@hauke-m.de>
921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens *
1021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * Licensed under the GNU/GPL. See COPYING for details.
1121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens */
1221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
1321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens#include "bcma_private.h"
1421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
1521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens#include <linux/bcma/bcma.h>
1621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
1721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens#include <linux/serial.h>
1821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens#include <linux/serial_core.h>
1921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens#include <linux/serial_reg.h>
2021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens#include <linux/time.h>
2121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
2221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens/* The 47162a0 hangs when reading MIPS DMP registers registers */
2321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic inline bool bcma_core_mips_bcm47162a0_quirk(struct bcma_device *dev)
2421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
2521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	return dev->bus->chipinfo.id == 47162 && dev->bus->chipinfo.rev == 0 &&
2621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	       dev->id.id == BCMA_CORE_MIPS_74K;
2721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
2821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
2921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens/* The 5357b0 hangs when reading USB20H DMP registers */
3021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic inline bool bcma_core_mips_bcm5357b0_quirk(struct bcma_device *dev)
3121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
3221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	return (dev->bus->chipinfo.id == 0x5357 ||
3321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		dev->bus->chipinfo.id == 0x4749) &&
3421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	       dev->bus->chipinfo.pkg == 11 &&
3521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	       dev->id.id == BCMA_CORE_USB20_HOST;
3621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
3721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
3821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic inline u32 mips_read32(struct bcma_drv_mips *mcore,
3921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			      u16 offset)
4021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
4121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	return bcma_read32(mcore->core, offset);
4221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
4321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
4421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic inline void mips_write32(struct bcma_drv_mips *mcore,
4521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens				u16 offset,
4621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens				u32 value)
4721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
4821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	bcma_write32(mcore->core, offset, value);
4921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
5021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
5121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic const u32 ipsflag_irq_mask[] = {
5221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	0,
5321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ1,
5421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ2,
5521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ3,
5621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ4,
5721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens};
5821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
5921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic const u32 ipsflag_irq_shift[] = {
6021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	0,
6121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ1_SHIFT,
6221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ2_SHIFT,
6321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ3_SHIFT,
6421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BCMA_MIPS_IPSFLAG_IRQ4_SHIFT,
6521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens};
6621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
6721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic u32 bcma_core_mips_irqflag(struct bcma_device *dev)
6821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
6921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	u32 flag;
7021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
7121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	if (bcma_core_mips_bcm47162a0_quirk(dev))
7221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		return dev->core_index;
7321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	if (bcma_core_mips_bcm5357b0_quirk(dev))
7421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		return dev->core_index;
7521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	flag = bcma_aread32(dev, BCMA_MIPS_OOBSELOUTA30);
7621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
7721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	return flag & 0x1F;
7821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
7921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
8021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens/* Get the MIPS IRQ assignment for a specified device.
8121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens * If unassigned, 0 is returned.
8221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens */
8321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensunsigned int bcma_core_mips_irq(struct bcma_device *dev)
8421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
8521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_device *mdev = dev->bus->drv_mips.core;
8621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	u32 irqflag;
8721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	unsigned int irq;
8821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
8921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	irqflag = bcma_core_mips_irqflag(dev);
9021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
9121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	for (irq = 1; irq <= 4; irq++)
9221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		if (bcma_read32(mdev, BCMA_MIPS_MIPS74K_INTMASK(irq)) &
9321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		    (1 << irqflag))
9421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			return irq;
9521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
9621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	return 0;
9721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
9821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke MehrtensEXPORT_SYMBOL(bcma_core_mips_irq);
9921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
10021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic void bcma_core_mips_set_irq(struct bcma_device *dev, unsigned int irq)
10121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
10221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	unsigned int oldirq = bcma_core_mips_irq(dev);
10321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_bus *bus = dev->bus;
10421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_device *mdev = bus->drv_mips.core;
10521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	u32 irqflag;
10621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
10721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	irqflag = bcma_core_mips_irqflag(dev);
10821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	BUG_ON(oldirq == 6);
10921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
11021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	dev->irq = irq + 2;
11121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
11221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	/* clear the old irq */
11321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	if (oldirq == 0)
11421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0),
11521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			    bcma_read32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0)) &
11621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			    ~(1 << irqflag));
11721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	else
11821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(irq), 0);
11921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
12021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	/* assign the new one */
12121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	if (irq == 0) {
12221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0),
12321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			    bcma_read32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0)) |
12421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			    (1 << irqflag));
12521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	} else {
12621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		u32 oldirqflag = bcma_read32(mdev,
12721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens					     BCMA_MIPS_MIPS74K_INTMASK(irq));
12821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		if (oldirqflag) {
12921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			struct bcma_device *core;
13021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
13121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			/* backplane irq line is in use, find out who uses
13221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			 * it and set user to irq 0
13321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			 */
13421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			list_for_each_entry_reverse(core, &bus->cores, list) {
13521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens				if ((1 << bcma_core_mips_irqflag(core)) ==
13621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens				    oldirqflag) {
13721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens					bcma_core_mips_set_irq(core, 0);
13821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens					break;
13921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens				}
14021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			}
14121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		}
14221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(irq),
14321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			     1 << irqflag);
14421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	}
14521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
14621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	pr_info("set_irq: core 0x%04x, irq %d => %d\n",
14721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		dev->id.id, oldirq + 2, irq + 2);
14821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
14921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
15021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic void bcma_core_mips_print_irq(struct bcma_device *dev, unsigned int irq)
15121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
15221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	int i;
15321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
15421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	printk(KERN_INFO KBUILD_MODNAME ": core 0x%04x, irq :", dev->id.id);
15521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	for (i = 0; i <= 6; i++)
15621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		printk(" %s%s", irq_name[i], i == irq ? "*" : " ");
15721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	printk("\n");
15821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
15921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
16021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic void bcma_core_mips_dump_irq(struct bcma_bus *bus)
16121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
16221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_device *core;
16321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
16421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	list_for_each_entry_reverse(core, &bus->cores, list) {
16521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bcma_core_mips_print_irq(core, bcma_core_mips_irq(core));
16621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	}
16721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
16821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
169908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtensu32 bcma_cpu_clock(struct bcma_drv_mips *mcore)
170908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens{
171908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens	struct bcma_bus *bus = mcore->core->bus;
172908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens
173908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens	if (bus->drv_cc.capabilities & BCMA_CC_CAP_PMU)
174908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens		return bcma_pmu_get_clockcpu(&bus->drv_cc);
175908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens
176908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens	pr_err("No PMU available, need this to get the cpu clock\n");
177908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens	return 0;
178908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens}
179908debc8da0d5a91418f71c6a462f62bd2ac69efHauke MehrtensEXPORT_SYMBOL(bcma_cpu_clock);
180908debc8da0d5a91418f71c6a462f62bd2ac69efHauke Mehrtens
18121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensstatic void bcma_core_mips_flash_detect(struct bcma_drv_mips *mcore)
18221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
18321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_bus *bus = mcore->core->bus;
18421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
18521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	switch (bus->drv_cc.capabilities & BCMA_CC_CAP_FLASHT) {
18621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	case BCMA_CC_FLASHT_STSER:
18721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	case BCMA_CC_FLASHT_ATSER:
18821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		pr_err("Serial flash not supported.\n");
18921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		break;
19021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	case BCMA_CC_FLASHT_PARA:
19121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		pr_info("found parallel flash.\n");
19221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bus->drv_cc.pflash.window = 0x1c000000;
19321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		bus->drv_cc.pflash.window_size = 0x02000000;
19421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
19521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		if ((bcma_read32(bus->drv_cc.core, BCMA_CC_FLASH_CFG) &
19621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		     BCMA_CC_FLASH_CFG_DS) == 0)
19721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			bus->drv_cc.pflash.buswidth = 1;
19821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		else
19921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			bus->drv_cc.pflash.buswidth = 2;
20021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		break;
20121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	default:
20221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		pr_err("flash not supported.\n");
20321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	}
20421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
20521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
20621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtensvoid bcma_core_mips_init(struct bcma_drv_mips *mcore)
20721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens{
20821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_bus *bus;
20921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	struct bcma_device *core;
21021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	bus = mcore->core->bus;
21121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
21221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	pr_info("Initializing MIPS core...\n");
21321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
21421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	if (!mcore->setup_done)
21521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		mcore->assigned_irqs = 1;
21621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
21721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	/* Assign IRQs to all cores on the bus */
21821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	list_for_each_entry_reverse(core, &bus->cores, list) {
21921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		int mips_irq;
22021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		if (core->irq)
22121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			continue;
22221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
22321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		mips_irq = bcma_core_mips_irq(core);
22421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		if (mips_irq > 4)
22521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			core->irq = 0;
22621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		else
22721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			core->irq = mips_irq + 2;
22821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		if (core->irq > 5)
22921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			continue;
23021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		switch (core->id.id) {
23121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_PCI:
23221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_PCIE:
23321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_ETHERNET:
23421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_ETHERNET_GBIT:
23521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_MAC_GBIT:
23621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_80211:
23721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		case BCMA_CORE_USB20_HOST:
23821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			/* These devices get their own IRQ line if available,
23921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			 * the rest goes on IRQ0
24021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			 */
24121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			if (mcore->assigned_irqs <= 4)
24221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens				bcma_core_mips_set_irq(core,
24321e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens						       mcore->assigned_irqs++);
24421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens			break;
24521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		}
24621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	}
24721e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	pr_info("IRQ reconfiguration done\n");
24821e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	bcma_core_mips_dump_irq(bus);
24921e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
25021e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	if (mcore->setup_done)
25121e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens		return;
25221e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens
253e3afe0e5be7576ac1282ea9fbbc9b352bb379227Hauke Mehrtens	bcma_chipco_serial_init(&bus->drv_cc);
25421e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	bcma_core_mips_flash_detect(mcore);
25521e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens	mcore->setup_done = true;
25621e0534ad7415559bb8dee0dc00e39646fed83c9Hauke Mehrtens}
257