1 /* 2 * This file is subject to the terms and conditions of the GNU General Public 3 * License. See the file "COPYING" in the main directory of this archive 4 * for more details. 5 * 6 * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> 7 * Copyright (C) 2009 Florian Fainelli <florian@openwrt.org> 8 */ 9 10 #include <linux/kernel.h> 11 #include <linux/module.h> 12 #include <linux/cpu.h> 13 #include <asm/cpu.h> 14 #include <asm/cpu-info.h> 15 #include <asm/mipsregs.h> 16 #include <bcm63xx_cpu.h> 17 #include <bcm63xx_regs.h> 18 #include <bcm63xx_io.h> 19 #include <bcm63xx_irq.h> 20 21 const unsigned long *bcm63xx_regs_base; 22 EXPORT_SYMBOL(bcm63xx_regs_base); 23 24 const int *bcm63xx_irqs; 25 EXPORT_SYMBOL(bcm63xx_irqs); 26 27 u16 bcm63xx_cpu_id __read_mostly; 28 EXPORT_SYMBOL(bcm63xx_cpu_id); 29 30 static u8 bcm63xx_cpu_rev; 31 static unsigned int bcm63xx_cpu_freq; 32 static unsigned int bcm63xx_memory_size; 33 34 static const unsigned long bcm3368_regs_base[] = { 35 __GEN_CPU_REGS_TABLE(3368) 36 }; 37 38 static const int bcm3368_irqs[] = { 39 __GEN_CPU_IRQ_TABLE(3368) 40 }; 41 42 static const unsigned long bcm6328_regs_base[] = { 43 __GEN_CPU_REGS_TABLE(6328) 44 }; 45 46 static const int bcm6328_irqs[] = { 47 __GEN_CPU_IRQ_TABLE(6328) 48 }; 49 50 static const unsigned long bcm6338_regs_base[] = { 51 __GEN_CPU_REGS_TABLE(6338) 52 }; 53 54 static const int bcm6338_irqs[] = { 55 __GEN_CPU_IRQ_TABLE(6338) 56 }; 57 58 static const unsigned long bcm6345_regs_base[] = { 59 __GEN_CPU_REGS_TABLE(6345) 60 }; 61 62 static const int bcm6345_irqs[] = { 63 __GEN_CPU_IRQ_TABLE(6345) 64 }; 65 66 static const unsigned long bcm6348_regs_base[] = { 67 __GEN_CPU_REGS_TABLE(6348) 68 }; 69 70 static const int bcm6348_irqs[] = { 71 __GEN_CPU_IRQ_TABLE(6348) 72 73 }; 74 75 static const unsigned long bcm6358_regs_base[] = { 76 __GEN_CPU_REGS_TABLE(6358) 77 }; 78 79 static const int bcm6358_irqs[] = { 80 __GEN_CPU_IRQ_TABLE(6358) 81 82 }; 83 84 static const unsigned long bcm6362_regs_base[] = { 85 __GEN_CPU_REGS_TABLE(6362) 86 }; 87 88 static const int bcm6362_irqs[] = { 89 __GEN_CPU_IRQ_TABLE(6362) 90 91 }; 92 93 static const unsigned long bcm6368_regs_base[] = { 94 __GEN_CPU_REGS_TABLE(6368) 95 }; 96 97 static const int bcm6368_irqs[] = { 98 __GEN_CPU_IRQ_TABLE(6368) 99 100 }; 101 102 u8 bcm63xx_get_cpu_rev(void) 103 { 104 return bcm63xx_cpu_rev; 105 } 106 107 EXPORT_SYMBOL(bcm63xx_get_cpu_rev); 108 109 unsigned int bcm63xx_get_cpu_freq(void) 110 { 111 return bcm63xx_cpu_freq; 112 } 113 114 unsigned int bcm63xx_get_memory_size(void) 115 { 116 return bcm63xx_memory_size; 117 } 118 119 static unsigned int detect_cpu_clock(void) 120 { 121 u16 cpu_id = bcm63xx_get_cpu_id(); 122 123 switch (cpu_id) { 124 case BCM3368_CPU_ID: 125 return 300000000; 126 127 case BCM6328_CPU_ID: 128 { 129 unsigned int tmp, mips_pll_fcvo; 130 131 tmp = bcm_misc_readl(MISC_STRAPBUS_6328_REG); 132 mips_pll_fcvo = (tmp & STRAPBUS_6328_FCVO_MASK) 133 >> STRAPBUS_6328_FCVO_SHIFT; 134 135 switch (mips_pll_fcvo) { 136 case 0x12: 137 case 0x14: 138 case 0x19: 139 return 160000000; 140 case 0x1c: 141 return 192000000; 142 case 0x13: 143 case 0x15: 144 return 200000000; 145 case 0x1a: 146 return 384000000; 147 case 0x16: 148 return 400000000; 149 default: 150 return 320000000; 151 } 152 153 } 154 case BCM6338_CPU_ID: 155 /* BCM6338 has a fixed 240 Mhz frequency */ 156 return 240000000; 157 158 case BCM6345_CPU_ID: 159 /* BCM6345 has a fixed 140Mhz frequency */ 160 return 140000000; 161 162 case BCM6348_CPU_ID: 163 { 164 unsigned int tmp, n1, n2, m1; 165 166 /* 16MHz * (N1 + 1) * (N2 + 2) / (M1_CPU + 1) */ 167 tmp = bcm_perf_readl(PERF_MIPSPLLCTL_REG); 168 n1 = (tmp & MIPSPLLCTL_N1_MASK) >> MIPSPLLCTL_N1_SHIFT; 169 n2 = (tmp & MIPSPLLCTL_N2_MASK) >> MIPSPLLCTL_N2_SHIFT; 170 m1 = (tmp & MIPSPLLCTL_M1CPU_MASK) >> MIPSPLLCTL_M1CPU_SHIFT; 171 n1 += 1; 172 n2 += 2; 173 m1 += 1; 174 return (16 * 1000000 * n1 * n2) / m1; 175 } 176 177 case BCM6358_CPU_ID: 178 { 179 unsigned int tmp, n1, n2, m1; 180 181 /* 16MHz * N1 * N2 / M1_CPU */ 182 tmp = bcm_ddr_readl(DDR_DMIPSPLLCFG_REG); 183 n1 = (tmp & DMIPSPLLCFG_N1_MASK) >> DMIPSPLLCFG_N1_SHIFT; 184 n2 = (tmp & DMIPSPLLCFG_N2_MASK) >> DMIPSPLLCFG_N2_SHIFT; 185 m1 = (tmp & DMIPSPLLCFG_M1_MASK) >> DMIPSPLLCFG_M1_SHIFT; 186 return (16 * 1000000 * n1 * n2) / m1; 187 } 188 189 case BCM6362_CPU_ID: 190 { 191 unsigned int tmp, mips_pll_fcvo; 192 193 tmp = bcm_misc_readl(MISC_STRAPBUS_6362_REG); 194 mips_pll_fcvo = (tmp & STRAPBUS_6362_FCVO_MASK) 195 >> STRAPBUS_6362_FCVO_SHIFT; 196 switch (mips_pll_fcvo) { 197 case 0x03: 198 case 0x0b: 199 case 0x13: 200 case 0x1b: 201 return 240000000; 202 case 0x04: 203 case 0x0c: 204 case 0x14: 205 case 0x1c: 206 return 160000000; 207 case 0x05: 208 case 0x0e: 209 case 0x16: 210 case 0x1e: 211 case 0x1f: 212 return 400000000; 213 case 0x06: 214 return 440000000; 215 case 0x07: 216 case 0x17: 217 return 384000000; 218 case 0x15: 219 case 0x1d: 220 return 200000000; 221 default: 222 return 320000000; 223 } 224 } 225 case BCM6368_CPU_ID: 226 { 227 unsigned int tmp, p1, p2, ndiv, m1; 228 229 /* (64MHz / P1) * P2 * NDIV / M1_CPU */ 230 tmp = bcm_ddr_readl(DDR_DMIPSPLLCFG_6368_REG); 231 232 p1 = (tmp & DMIPSPLLCFG_6368_P1_MASK) >> 233 DMIPSPLLCFG_6368_P1_SHIFT; 234 235 p2 = (tmp & DMIPSPLLCFG_6368_P2_MASK) >> 236 DMIPSPLLCFG_6368_P2_SHIFT; 237 238 ndiv = (tmp & DMIPSPLLCFG_6368_NDIV_MASK) >> 239 DMIPSPLLCFG_6368_NDIV_SHIFT; 240 241 tmp = bcm_ddr_readl(DDR_DMIPSPLLDIV_6368_REG); 242 m1 = (tmp & DMIPSPLLDIV_6368_MDIV_MASK) >> 243 DMIPSPLLDIV_6368_MDIV_SHIFT; 244 245 return (((64 * 1000000) / p1) * p2 * ndiv) / m1; 246 } 247 248 default: 249 panic("Failed to detect clock for CPU with id=%04X\n", cpu_id); 250 } 251 } 252 253 /* 254 * attempt to detect the amount of memory installed 255 */ 256 static unsigned int detect_memory_size(void) 257 { 258 unsigned int cols = 0, rows = 0, is_32bits = 0, banks = 0; 259 u32 val; 260 261 if (BCMCPU_IS_6328() || BCMCPU_IS_6362()) 262 return bcm_ddr_readl(DDR_CSEND_REG) << 24; 263 264 if (BCMCPU_IS_6345()) { 265 val = bcm_sdram_readl(SDRAM_MBASE_REG); 266 return (val * 8 * 1024 * 1024); 267 } 268 269 if (BCMCPU_IS_6338() || BCMCPU_IS_6348()) { 270 val = bcm_sdram_readl(SDRAM_CFG_REG); 271 rows = (val & SDRAM_CFG_ROW_MASK) >> SDRAM_CFG_ROW_SHIFT; 272 cols = (val & SDRAM_CFG_COL_MASK) >> SDRAM_CFG_COL_SHIFT; 273 is_32bits = (val & SDRAM_CFG_32B_MASK) ? 1 : 0; 274 banks = (val & SDRAM_CFG_BANK_MASK) ? 2 : 1; 275 } 276 277 if (BCMCPU_IS_3368() || BCMCPU_IS_6358() || BCMCPU_IS_6368()) { 278 val = bcm_memc_readl(MEMC_CFG_REG); 279 rows = (val & MEMC_CFG_ROW_MASK) >> MEMC_CFG_ROW_SHIFT; 280 cols = (val & MEMC_CFG_COL_MASK) >> MEMC_CFG_COL_SHIFT; 281 is_32bits = (val & MEMC_CFG_32B_MASK) ? 0 : 1; 282 banks = 2; 283 } 284 285 /* 0 => 11 address bits ... 2 => 13 address bits */ 286 rows += 11; 287 288 /* 0 => 8 address bits ... 2 => 10 address bits */ 289 cols += 8; 290 291 return 1 << (cols + rows + (is_32bits + 1) + banks); 292 } 293 294 void __init bcm63xx_cpu_init(void) 295 { 296 unsigned int tmp; 297 unsigned int cpu = smp_processor_id(); 298 u32 chipid_reg; 299 300 /* soc registers location depends on cpu type */ 301 chipid_reg = 0; 302 303 switch (current_cpu_type()) { 304 case CPU_BMIPS3300: 305 if ((read_c0_prid() & PRID_IMP_MASK) != PRID_IMP_BMIPS3300_ALT) 306 __cpu_name[cpu] = "Broadcom BCM6338"; 307 /* fall-through */ 308 case CPU_BMIPS32: 309 chipid_reg = BCM_6345_PERF_BASE; 310 break; 311 case CPU_BMIPS4350: 312 switch ((read_c0_prid() & PRID_REV_MASK)) { 313 case 0x04: 314 chipid_reg = BCM_3368_PERF_BASE; 315 break; 316 case 0x10: 317 chipid_reg = BCM_6345_PERF_BASE; 318 break; 319 default: 320 chipid_reg = BCM_6368_PERF_BASE; 321 break; 322 } 323 break; 324 } 325 326 /* 327 * really early to panic, but delaying panic would not help since we 328 * will never get any working console 329 */ 330 if (!chipid_reg) 331 panic("unsupported Broadcom CPU"); 332 333 /* read out CPU type */ 334 tmp = bcm_readl(chipid_reg); 335 bcm63xx_cpu_id = (tmp & REV_CHIPID_MASK) >> REV_CHIPID_SHIFT; 336 bcm63xx_cpu_rev = (tmp & REV_REVID_MASK) >> REV_REVID_SHIFT; 337 338 switch (bcm63xx_cpu_id) { 339 case BCM3368_CPU_ID: 340 bcm63xx_regs_base = bcm3368_regs_base; 341 bcm63xx_irqs = bcm3368_irqs; 342 break; 343 case BCM6328_CPU_ID: 344 bcm63xx_regs_base = bcm6328_regs_base; 345 bcm63xx_irqs = bcm6328_irqs; 346 break; 347 case BCM6338_CPU_ID: 348 bcm63xx_regs_base = bcm6338_regs_base; 349 bcm63xx_irqs = bcm6338_irqs; 350 break; 351 case BCM6345_CPU_ID: 352 bcm63xx_regs_base = bcm6345_regs_base; 353 bcm63xx_irqs = bcm6345_irqs; 354 break; 355 case BCM6348_CPU_ID: 356 bcm63xx_regs_base = bcm6348_regs_base; 357 bcm63xx_irqs = bcm6348_irqs; 358 break; 359 case BCM6358_CPU_ID: 360 bcm63xx_regs_base = bcm6358_regs_base; 361 bcm63xx_irqs = bcm6358_irqs; 362 break; 363 case BCM6362_CPU_ID: 364 bcm63xx_regs_base = bcm6362_regs_base; 365 bcm63xx_irqs = bcm6362_irqs; 366 break; 367 case BCM6368_CPU_ID: 368 bcm63xx_regs_base = bcm6368_regs_base; 369 bcm63xx_irqs = bcm6368_irqs; 370 break; 371 default: 372 panic("unsupported broadcom CPU %x", bcm63xx_cpu_id); 373 break; 374 } 375 376 bcm63xx_cpu_freq = detect_cpu_clock(); 377 bcm63xx_memory_size = detect_memory_size(); 378 379 printk(KERN_INFO "Detected Broadcom 0x%04x CPU revision %02x\n", 380 bcm63xx_cpu_id, bcm63xx_cpu_rev); 381 printk(KERN_INFO "CPU frequency is %u MHz\n", 382 bcm63xx_cpu_freq / 1000000); 383 printk(KERN_INFO "%uMB of RAM installed\n", 384 bcm63xx_memory_size >> 20); 385 } 386