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