| /* |
| * This file is subject to the terms and conditions of the GNU General Public |
| * License. See the file "COPYING" in the main directory of this archive |
| * for more details. |
| * |
| * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> |
| * Copyright (C) 2009 Florian Fainelli <florian@openwrt.org> |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/cpu.h> |
| #include <asm/cpu.h> |
| #include <asm/cpu-info.h> |
| #include <asm/mipsregs.h> |
| #include <bcm63xx_cpu.h> |
| #include <bcm63xx_regs.h> |
| #include <bcm63xx_io.h> |
| #include <bcm63xx_irq.h> |
| |
| const unsigned long *bcm63xx_regs_base; |
| EXPORT_SYMBOL(bcm63xx_regs_base); |
| |
| const int *bcm63xx_irqs; |
| EXPORT_SYMBOL(bcm63xx_irqs); |
| |
| u16 bcm63xx_cpu_id __read_mostly; |
| EXPORT_SYMBOL(bcm63xx_cpu_id); |
| |
| static u8 bcm63xx_cpu_rev; |
| static unsigned int bcm63xx_cpu_freq; |
| static unsigned int bcm63xx_memory_size; |
| |
| static const unsigned long bcm3368_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(3368) |
| }; |
| |
| static const int bcm3368_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(3368) |
| }; |
| |
| static const unsigned long bcm6328_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6328) |
| }; |
| |
| static const int bcm6328_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6328) |
| }; |
| |
| static const unsigned long bcm6338_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6338) |
| }; |
| |
| static const int bcm6338_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6338) |
| }; |
| |
| static const unsigned long bcm6345_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6345) |
| }; |
| |
| static const int bcm6345_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6345) |
| }; |
| |
| static const unsigned long bcm6348_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6348) |
| }; |
| |
| static const int bcm6348_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6348) |
| |
| }; |
| |
| static const unsigned long bcm6358_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6358) |
| }; |
| |
| static const int bcm6358_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6358) |
| |
| }; |
| |
| static const unsigned long bcm6362_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6362) |
| }; |
| |
| static const int bcm6362_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6362) |
| |
| }; |
| |
| static const unsigned long bcm6368_regs_base[] = { |
| __GEN_CPU_REGS_TABLE(6368) |
| }; |
| |
| static const int bcm6368_irqs[] = { |
| __GEN_CPU_IRQ_TABLE(6368) |
| |
| }; |
| |
| u8 bcm63xx_get_cpu_rev(void) |
| { |
| return bcm63xx_cpu_rev; |
| } |
| |
| EXPORT_SYMBOL(bcm63xx_get_cpu_rev); |
| |
| unsigned int bcm63xx_get_cpu_freq(void) |
| { |
| return bcm63xx_cpu_freq; |
| } |
| |
| unsigned int bcm63xx_get_memory_size(void) |
| { |
| return bcm63xx_memory_size; |
| } |
| |
| static unsigned int detect_cpu_clock(void) |
| { |
| u16 cpu_id = bcm63xx_get_cpu_id(); |
| |
| switch (cpu_id) { |
| case BCM3368_CPU_ID: |
| return 300000000; |
| |
| case BCM6328_CPU_ID: |
| { |
| unsigned int tmp, mips_pll_fcvo; |
| |
| tmp = bcm_misc_readl(MISC_STRAPBUS_6328_REG); |
| mips_pll_fcvo = (tmp & STRAPBUS_6328_FCVO_MASK) |
| >> STRAPBUS_6328_FCVO_SHIFT; |
| |
| switch (mips_pll_fcvo) { |
| case 0x12: |
| case 0x14: |
| case 0x19: |
| return 160000000; |
| case 0x1c: |
| return 192000000; |
| case 0x13: |
| case 0x15: |
| return 200000000; |
| case 0x1a: |
| return 384000000; |
| case 0x16: |
| return 400000000; |
| default: |
| return 320000000; |
| } |
| |
| } |
| case BCM6338_CPU_ID: |
| /* BCM6338 has a fixed 240 Mhz frequency */ |
| return 240000000; |
| |
| case BCM6345_CPU_ID: |
| /* BCM6345 has a fixed 140Mhz frequency */ |
| return 140000000; |
| |
| case BCM6348_CPU_ID: |
| { |
| unsigned int tmp, n1, n2, m1; |
| |
| /* 16MHz * (N1 + 1) * (N2 + 2) / (M1_CPU + 1) */ |
| tmp = bcm_perf_readl(PERF_MIPSPLLCTL_REG); |
| n1 = (tmp & MIPSPLLCTL_N1_MASK) >> MIPSPLLCTL_N1_SHIFT; |
| n2 = (tmp & MIPSPLLCTL_N2_MASK) >> MIPSPLLCTL_N2_SHIFT; |
| m1 = (tmp & MIPSPLLCTL_M1CPU_MASK) >> MIPSPLLCTL_M1CPU_SHIFT; |
| n1 += 1; |
| n2 += 2; |
| m1 += 1; |
| return (16 * 1000000 * n1 * n2) / m1; |
| } |
| |
| case BCM6358_CPU_ID: |
| { |
| unsigned int tmp, n1, n2, m1; |
| |
| /* 16MHz * N1 * N2 / M1_CPU */ |
| tmp = bcm_ddr_readl(DDR_DMIPSPLLCFG_REG); |
| n1 = (tmp & DMIPSPLLCFG_N1_MASK) >> DMIPSPLLCFG_N1_SHIFT; |
| n2 = (tmp & DMIPSPLLCFG_N2_MASK) >> DMIPSPLLCFG_N2_SHIFT; |
| m1 = (tmp & DMIPSPLLCFG_M1_MASK) >> DMIPSPLLCFG_M1_SHIFT; |
| return (16 * 1000000 * n1 * n2) / m1; |
| } |
| |
| case BCM6362_CPU_ID: |
| { |
| unsigned int tmp, mips_pll_fcvo; |
| |
| tmp = bcm_misc_readl(MISC_STRAPBUS_6362_REG); |
| mips_pll_fcvo = (tmp & STRAPBUS_6362_FCVO_MASK) |
| >> STRAPBUS_6362_FCVO_SHIFT; |
| switch (mips_pll_fcvo) { |
| case 0x03: |
| case 0x0b: |
| case 0x13: |
| case 0x1b: |
| return 240000000; |
| case 0x04: |
| case 0x0c: |
| case 0x14: |
| case 0x1c: |
| return 160000000; |
| case 0x05: |
| case 0x0e: |
| case 0x16: |
| case 0x1e: |
| case 0x1f: |
| return 400000000; |
| case 0x06: |
| return 440000000; |
| case 0x07: |
| case 0x17: |
| return 384000000; |
| case 0x15: |
| case 0x1d: |
| return 200000000; |
| default: |
| return 320000000; |
| } |
| } |
| case BCM6368_CPU_ID: |
| { |
| unsigned int tmp, p1, p2, ndiv, m1; |
| |
| /* (64MHz / P1) * P2 * NDIV / M1_CPU */ |
| tmp = bcm_ddr_readl(DDR_DMIPSPLLCFG_6368_REG); |
| |
| p1 = (tmp & DMIPSPLLCFG_6368_P1_MASK) >> |
| DMIPSPLLCFG_6368_P1_SHIFT; |
| |
| p2 = (tmp & DMIPSPLLCFG_6368_P2_MASK) >> |
| DMIPSPLLCFG_6368_P2_SHIFT; |
| |
| ndiv = (tmp & DMIPSPLLCFG_6368_NDIV_MASK) >> |
| DMIPSPLLCFG_6368_NDIV_SHIFT; |
| |
| tmp = bcm_ddr_readl(DDR_DMIPSPLLDIV_6368_REG); |
| m1 = (tmp & DMIPSPLLDIV_6368_MDIV_MASK) >> |
| DMIPSPLLDIV_6368_MDIV_SHIFT; |
| |
| return (((64 * 1000000) / p1) * p2 * ndiv) / m1; |
| } |
| |
| default: |
| panic("Failed to detect clock for CPU with id=%04X\n", cpu_id); |
| } |
| } |
| |
| /* |
| * attempt to detect the amount of memory installed |
| */ |
| static unsigned int detect_memory_size(void) |
| { |
| unsigned int cols = 0, rows = 0, is_32bits = 0, banks = 0; |
| u32 val; |
| |
| if (BCMCPU_IS_6328() || BCMCPU_IS_6362()) |
| return bcm_ddr_readl(DDR_CSEND_REG) << 24; |
| |
| if (BCMCPU_IS_6345()) { |
| val = bcm_sdram_readl(SDRAM_MBASE_REG); |
| return (val * 8 * 1024 * 1024); |
| } |
| |
| if (BCMCPU_IS_6338() || BCMCPU_IS_6348()) { |
| val = bcm_sdram_readl(SDRAM_CFG_REG); |
| rows = (val & SDRAM_CFG_ROW_MASK) >> SDRAM_CFG_ROW_SHIFT; |
| cols = (val & SDRAM_CFG_COL_MASK) >> SDRAM_CFG_COL_SHIFT; |
| is_32bits = (val & SDRAM_CFG_32B_MASK) ? 1 : 0; |
| banks = (val & SDRAM_CFG_BANK_MASK) ? 2 : 1; |
| } |
| |
| if (BCMCPU_IS_3368() || BCMCPU_IS_6358() || BCMCPU_IS_6368()) { |
| val = bcm_memc_readl(MEMC_CFG_REG); |
| rows = (val & MEMC_CFG_ROW_MASK) >> MEMC_CFG_ROW_SHIFT; |
| cols = (val & MEMC_CFG_COL_MASK) >> MEMC_CFG_COL_SHIFT; |
| is_32bits = (val & MEMC_CFG_32B_MASK) ? 0 : 1; |
| banks = 2; |
| } |
| |
| /* 0 => 11 address bits ... 2 => 13 address bits */ |
| rows += 11; |
| |
| /* 0 => 8 address bits ... 2 => 10 address bits */ |
| cols += 8; |
| |
| return 1 << (cols + rows + (is_32bits + 1) + banks); |
| } |
| |
| void __init bcm63xx_cpu_init(void) |
| { |
| unsigned int tmp; |
| unsigned int cpu = smp_processor_id(); |
| u32 chipid_reg; |
| |
| /* soc registers location depends on cpu type */ |
| chipid_reg = 0; |
| |
| switch (current_cpu_type()) { |
| case CPU_BMIPS3300: |
| if ((read_c0_prid() & PRID_IMP_MASK) != PRID_IMP_BMIPS3300_ALT) |
| __cpu_name[cpu] = "Broadcom BCM6338"; |
| /* fall-through */ |
| case CPU_BMIPS32: |
| chipid_reg = BCM_6345_PERF_BASE; |
| break; |
| case CPU_BMIPS4350: |
| switch ((read_c0_prid() & PRID_REV_MASK)) { |
| case 0x04: |
| chipid_reg = BCM_3368_PERF_BASE; |
| break; |
| case 0x10: |
| chipid_reg = BCM_6345_PERF_BASE; |
| break; |
| default: |
| chipid_reg = BCM_6368_PERF_BASE; |
| break; |
| } |
| break; |
| } |
| |
| /* |
| * really early to panic, but delaying panic would not help since we |
| * will never get any working console |
| */ |
| if (!chipid_reg) |
| panic("unsupported Broadcom CPU"); |
| |
| /* read out CPU type */ |
| tmp = bcm_readl(chipid_reg); |
| bcm63xx_cpu_id = (tmp & REV_CHIPID_MASK) >> REV_CHIPID_SHIFT; |
| bcm63xx_cpu_rev = (tmp & REV_REVID_MASK) >> REV_REVID_SHIFT; |
| |
| switch (bcm63xx_cpu_id) { |
| case BCM3368_CPU_ID: |
| bcm63xx_regs_base = bcm3368_regs_base; |
| bcm63xx_irqs = bcm3368_irqs; |
| break; |
| case BCM6328_CPU_ID: |
| bcm63xx_regs_base = bcm6328_regs_base; |
| bcm63xx_irqs = bcm6328_irqs; |
| break; |
| case BCM6338_CPU_ID: |
| bcm63xx_regs_base = bcm6338_regs_base; |
| bcm63xx_irqs = bcm6338_irqs; |
| break; |
| case BCM6345_CPU_ID: |
| bcm63xx_regs_base = bcm6345_regs_base; |
| bcm63xx_irqs = bcm6345_irqs; |
| break; |
| case BCM6348_CPU_ID: |
| bcm63xx_regs_base = bcm6348_regs_base; |
| bcm63xx_irqs = bcm6348_irqs; |
| break; |
| case BCM6358_CPU_ID: |
| bcm63xx_regs_base = bcm6358_regs_base; |
| bcm63xx_irqs = bcm6358_irqs; |
| break; |
| case BCM6362_CPU_ID: |
| bcm63xx_regs_base = bcm6362_regs_base; |
| bcm63xx_irqs = bcm6362_irqs; |
| break; |
| case BCM6368_CPU_ID: |
| bcm63xx_regs_base = bcm6368_regs_base; |
| bcm63xx_irqs = bcm6368_irqs; |
| break; |
| default: |
| panic("unsupported broadcom CPU %x", bcm63xx_cpu_id); |
| break; |
| } |
| |
| bcm63xx_cpu_freq = detect_cpu_clock(); |
| bcm63xx_memory_size = detect_memory_size(); |
| |
| printk(KERN_INFO "Detected Broadcom 0x%04x CPU revision %02x\n", |
| bcm63xx_cpu_id, bcm63xx_cpu_rev); |
| printk(KERN_INFO "CPU frequency is %u MHz\n", |
| bcm63xx_cpu_freq / 1000000); |
| printk(KERN_INFO "%uMB of RAM installed\n", |
| bcm63xx_memory_size >> 20); |
| } |