1 /*- 2 * SPDX-License-Identifier: BSD-4-Clause AND BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2001 Matt Thomas. 5 * Copyright (c) 2001 Tsubai Masanari. 6 * Copyright (c) 1998, 1999, 2001 Internet Research Institute, Inc. 7 * All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 3. All advertising materials mentioning features or use of this software 18 * must display the following acknowledgement: 19 * This product includes software developed by 20 * Internet Research Institute, Inc. 21 * 4. The name of the author may not be used to endorse or promote products 22 * derived from this software without specific prior written permission. 23 * 24 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 25 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 26 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 27 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 28 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 29 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 30 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 31 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 32 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 34 */ 35 /*- 36 * Copyright (C) 2003 Benno Rice. 37 * All rights reserved. 38 * 39 * Redistribution and use in source and binary forms, with or without 40 * modification, are permitted provided that the following conditions 41 * are met: 42 * 1. Redistributions of source code must retain the above copyright 43 * notice, this list of conditions and the following disclaimer. 44 * 2. Redistributions in binary form must reproduce the above copyright 45 * notice, this list of conditions and the following disclaimer in the 46 * documentation and/or other materials provided with the distribution. 47 * 48 * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR 49 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 50 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 51 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 52 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 53 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 54 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 55 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 56 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 57 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 58 * 59 * from $NetBSD: cpu_subr.c,v 1.1 2003/02/03 17:10:09 matt Exp $ 60 * $FreeBSD$ 61 */ 62 63 #include <sys/param.h> 64 #include <sys/systm.h> 65 #include <sys/bus.h> 66 #include <sys/conf.h> 67 #include <sys/cpu.h> 68 #include <sys/kernel.h> 69 #include <sys/ktr.h> 70 #include <sys/lock.h> 71 #include <sys/proc.h> 72 #include <sys/sysctl.h> 73 #include <sys/sched.h> 74 #include <sys/smp.h> 75 76 #include <machine/bus.h> 77 #include <machine/cpu.h> 78 #include <machine/hid.h> 79 #include <machine/md_var.h> 80 #include <machine/smp.h> 81 #include <machine/spr.h> 82 83 #include <dev/ofw/openfirm.h> 84 85 static void cpu_6xx_setup(int cpuid, uint16_t vers); 86 static void cpu_970_setup(int cpuid, uint16_t vers); 87 static void cpu_booke_setup(int cpuid, uint16_t vers); 88 static void cpu_powerx_setup(int cpuid, uint16_t vers); 89 90 int powerpc_pow_enabled; 91 void (*cpu_idle_hook)(sbintime_t) = NULL; 92 static void cpu_idle_60x(sbintime_t); 93 static void cpu_idle_booke(sbintime_t); 94 #ifdef BOOKE_E500 95 static void cpu_idle_e500mc(sbintime_t sbt); 96 #endif 97 #if defined(__powerpc64__) && defined(AIM) 98 static void cpu_idle_powerx(sbintime_t); 99 static void cpu_idle_power9(sbintime_t); 100 #endif 101 102 struct cputab { 103 const char *name; 104 uint16_t version; 105 uint16_t revfmt; 106 int features; /* Do not include PPC_FEATURE_32 or 107 * PPC_FEATURE_HAS_MMU */ 108 int features2; 109 void (*cpu_setup)(int cpuid, uint16_t vers); 110 }; 111 #define REVFMT_MAJMIN 1 /* %u.%u */ 112 #define REVFMT_HEX 2 /* 0x%04x */ 113 #define REVFMT_DEC 3 /* %u */ 114 static const struct cputab models[] = { 115 { "Motorola PowerPC 601", MPC601, REVFMT_DEC, 116 PPC_FEATURE_HAS_FPU | PPC_FEATURE_UNIFIED_CACHE, 0, cpu_6xx_setup }, 117 { "Motorola PowerPC 602", MPC602, REVFMT_DEC, 118 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 119 { "Motorola PowerPC 603", MPC603, REVFMT_MAJMIN, 120 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 121 { "Motorola PowerPC 603e", MPC603e, REVFMT_MAJMIN, 122 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 123 { "Motorola PowerPC 603ev", MPC603ev, REVFMT_MAJMIN, 124 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 125 { "Motorola PowerPC 604", MPC604, REVFMT_MAJMIN, 126 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 127 { "Motorola PowerPC 604ev", MPC604ev, REVFMT_MAJMIN, 128 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 129 { "Motorola PowerPC 620", MPC620, REVFMT_HEX, 130 PPC_FEATURE_64 | PPC_FEATURE_HAS_FPU, 0, NULL }, 131 { "Motorola PowerPC 750", MPC750, REVFMT_MAJMIN, 132 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 133 { "IBM PowerPC 750FX", IBM750FX, REVFMT_MAJMIN, 134 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 135 { "IBM PowerPC 970", IBM970, REVFMT_MAJMIN, 136 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 137 0, cpu_970_setup }, 138 { "IBM PowerPC 970FX", IBM970FX, REVFMT_MAJMIN, 139 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 140 0, cpu_970_setup }, 141 { "IBM PowerPC 970GX", IBM970GX, REVFMT_MAJMIN, 142 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 143 0, cpu_970_setup }, 144 { "IBM PowerPC 970MP", IBM970MP, REVFMT_MAJMIN, 145 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 146 0, cpu_970_setup }, 147 { "IBM POWER4", IBMPOWER4, REVFMT_MAJMIN, 148 PPC_FEATURE_64 | PPC_FEATURE_HAS_FPU | PPC_FEATURE_POWER4, 0, NULL }, 149 { "IBM POWER4+", IBMPOWER4PLUS, REVFMT_MAJMIN, 150 PPC_FEATURE_64 | PPC_FEATURE_HAS_FPU | PPC_FEATURE_POWER4, 0, NULL }, 151 { "IBM POWER5", IBMPOWER5, REVFMT_MAJMIN, 152 PPC_FEATURE_64 | PPC_FEATURE_HAS_FPU | PPC_FEATURE_POWER4 | 153 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP, 0, NULL }, 154 { "IBM POWER5+", IBMPOWER5PLUS, REVFMT_MAJMIN, 155 PPC_FEATURE_64 | PPC_FEATURE_HAS_FPU | PPC_FEATURE_POWER5_PLUS | 156 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP, 0, NULL }, 157 { "IBM POWER6", IBMPOWER6, REVFMT_MAJMIN, 158 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 159 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP | PPC_FEATURE_ARCH_2_05 | 160 PPC_FEATURE_TRUE_LE, 0, NULL }, 161 { "IBM POWER7", IBMPOWER7, REVFMT_MAJMIN, 162 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 163 PPC_FEATURE_SMT | PPC_FEATURE_ARCH_2_05 | PPC_FEATURE_ARCH_2_06 | 164 PPC_FEATURE_HAS_VSX | PPC_FEATURE_TRUE_LE, PPC_FEATURE2_DSCR, NULL }, 165 { "IBM POWER7+", IBMPOWER7PLUS, REVFMT_MAJMIN, 166 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 167 PPC_FEATURE_SMT | PPC_FEATURE_ARCH_2_05 | PPC_FEATURE_ARCH_2_06 | 168 PPC_FEATURE_HAS_VSX, PPC_FEATURE2_DSCR, NULL }, 169 { "IBM POWER8E", IBMPOWER8E, REVFMT_MAJMIN, 170 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 171 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP | PPC_FEATURE_ARCH_2_05 | 172 PPC_FEATURE_ARCH_2_06 | PPC_FEATURE_HAS_VSX | PPC_FEATURE_TRUE_LE, 173 PPC_FEATURE2_ARCH_2_07 | PPC_FEATURE2_DSCR | PPC_FEATURE2_ISEL | 174 PPC_FEATURE2_TAR | PPC_FEATURE2_HAS_VEC_CRYPTO, cpu_powerx_setup }, 175 { "IBM POWER8NVL", IBMPOWER8NVL, REVFMT_MAJMIN, 176 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 177 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP | PPC_FEATURE_ARCH_2_05 | 178 PPC_FEATURE_ARCH_2_06 | PPC_FEATURE_HAS_VSX | PPC_FEATURE_TRUE_LE, 179 PPC_FEATURE2_ARCH_2_07 | PPC_FEATURE2_DSCR | PPC_FEATURE2_ISEL | 180 PPC_FEATURE2_TAR | PPC_FEATURE2_HAS_VEC_CRYPTO, cpu_powerx_setup }, 181 { "IBM POWER8", IBMPOWER8, REVFMT_MAJMIN, 182 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 183 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP | PPC_FEATURE_ARCH_2_05 | 184 PPC_FEATURE_ARCH_2_06 | PPC_FEATURE_HAS_VSX | PPC_FEATURE_TRUE_LE, 185 PPC_FEATURE2_ARCH_2_07 | PPC_FEATURE2_DSCR | PPC_FEATURE2_ISEL | 186 PPC_FEATURE2_TAR | PPC_FEATURE2_HAS_VEC_CRYPTO, cpu_powerx_setup }, 187 { "IBM POWER9", IBMPOWER9, REVFMT_MAJMIN, 188 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 189 PPC_FEATURE_SMT | PPC_FEATURE_ICACHE_SNOOP | PPC_FEATURE_ARCH_2_05 | 190 PPC_FEATURE_ARCH_2_06 | PPC_FEATURE_HAS_VSX | PPC_FEATURE_TRUE_LE, 191 PPC_FEATURE2_ARCH_2_07 | PPC_FEATURE2_DSCR | PPC_FEATURE2_EBB | 192 PPC_FEATURE2_ISEL | PPC_FEATURE2_TAR | PPC_FEATURE2_HAS_VEC_CRYPTO | 193 PPC_FEATURE2_ARCH_3_00 | PPC_FEATURE2_HAS_IEEE128 | 194 PPC_FEATURE2_DARN, cpu_powerx_setup }, 195 { "Motorola PowerPC 7400", MPC7400, REVFMT_MAJMIN, 196 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 197 { "Motorola PowerPC 7410", MPC7410, REVFMT_MAJMIN, 198 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 199 { "Motorola PowerPC 7450", MPC7450, REVFMT_MAJMIN, 200 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 201 { "Motorola PowerPC 7455", MPC7455, REVFMT_MAJMIN, 202 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 203 { "Motorola PowerPC 7457", MPC7457, REVFMT_MAJMIN, 204 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 205 { "Motorola PowerPC 7447A", MPC7447A, REVFMT_MAJMIN, 206 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 207 { "Motorola PowerPC 7448", MPC7448, REVFMT_MAJMIN, 208 PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 209 { "Motorola PowerPC 8240", MPC8240, REVFMT_MAJMIN, 210 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 211 { "Motorola PowerPC 8245", MPC8245, REVFMT_MAJMIN, 212 PPC_FEATURE_HAS_FPU, 0, cpu_6xx_setup }, 213 { "Freescale e500v1 core", FSL_E500v1, REVFMT_MAJMIN, 214 PPC_FEATURE_HAS_SPE | PPC_FEATURE_HAS_EFP_SINGLE | PPC_FEATURE_BOOKE, 215 PPC_FEATURE2_ISEL, cpu_booke_setup }, 216 { "Freescale e500v2 core", FSL_E500v2, REVFMT_MAJMIN, 217 PPC_FEATURE_HAS_SPE | PPC_FEATURE_BOOKE | 218 PPC_FEATURE_HAS_EFP_SINGLE | PPC_FEATURE_HAS_EFP_DOUBLE, 219 PPC_FEATURE2_ISEL, cpu_booke_setup }, 220 { "Freescale e500mc core", FSL_E500mc, REVFMT_MAJMIN, 221 PPC_FEATURE_HAS_FPU | PPC_FEATURE_BOOKE | PPC_FEATURE_ARCH_2_05 | 222 PPC_FEATURE_ARCH_2_06, PPC_FEATURE2_ISEL, 223 cpu_booke_setup }, 224 { "Freescale e5500 core", FSL_E5500, REVFMT_MAJMIN, 225 PPC_FEATURE_64 | PPC_FEATURE_HAS_FPU | PPC_FEATURE_BOOKE | 226 PPC_FEATURE_ARCH_2_05 | PPC_FEATURE_ARCH_2_06, 227 PPC_FEATURE2_ISEL, cpu_booke_setup }, 228 { "Freescale e6500 core", FSL_E6500, REVFMT_MAJMIN, 229 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 230 PPC_FEATURE_BOOKE | PPC_FEATURE_ARCH_2_05 | PPC_FEATURE_ARCH_2_06, 231 PPC_FEATURE2_ISEL, cpu_booke_setup }, 232 { "IBM Cell Broadband Engine", IBMCELLBE, REVFMT_MAJMIN, 233 PPC_FEATURE_64 | PPC_FEATURE_HAS_ALTIVEC | PPC_FEATURE_HAS_FPU | 234 PPC_FEATURE_CELL | PPC_FEATURE_SMT, 0, NULL}, 235 { "Unknown PowerPC CPU", 0, REVFMT_HEX, 0, 0, NULL }, 236 }; 237 238 static void cpu_6xx_print_cacheinfo(u_int, uint16_t); 239 static int cpu_feature_bit(SYSCTL_HANDLER_ARGS); 240 241 static char model[64]; 242 SYSCTL_STRING(_hw, HW_MODEL, model, CTLFLAG_RD, model, 0, ""); 243 244 static const struct cputab *cput; 245 246 u_long cpu_features = PPC_FEATURE_32 | PPC_FEATURE_HAS_MMU; 247 u_long cpu_features2 = 0; 248 SYSCTL_OPAQUE(_hw, OID_AUTO, cpu_features, CTLFLAG_RD, 249 &cpu_features, sizeof(cpu_features), "LX", "PowerPC CPU features"); 250 SYSCTL_OPAQUE(_hw, OID_AUTO, cpu_features2, CTLFLAG_RD, 251 &cpu_features2, sizeof(cpu_features2), "LX", "PowerPC CPU features 2"); 252 253 #ifdef __powerpc64__ 254 register_t lpcr = LPCR_LPES; 255 #endif 256 257 /* Provide some user-friendly aliases for bits in cpu_features */ 258 SYSCTL_PROC(_hw, OID_AUTO, floatingpoint, 259 CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, 0, PPC_FEATURE_HAS_FPU, 260 cpu_feature_bit, "I", "Floating point instructions executed in hardware"); 261 SYSCTL_PROC(_hw, OID_AUTO, altivec, CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, 262 0, PPC_FEATURE_HAS_ALTIVEC, cpu_feature_bit, "I", "CPU supports Altivec"); 263 264 /* 265 * Phase 1 (early) CPU setup. Setup the cpu_features/cpu_features2 variables, 266 * so they can be used during platform and MMU bringup. 267 */ 268 void 269 cpu_feature_setup() 270 { 271 u_int pvr; 272 uint16_t vers; 273 const struct cputab *cp; 274 275 pvr = mfpvr(); 276 vers = pvr >> 16; 277 for (cp = models; cp->version != 0; cp++) { 278 if (cp->version == vers) 279 break; 280 } 281 282 cput = cp; 283 cpu_features |= cp->features; 284 cpu_features2 |= cp->features2; 285 } 286 287 288 void 289 cpu_setup(u_int cpuid) 290 { 291 uint64_t cps; 292 const char *name; 293 u_int maj, min, pvr; 294 uint16_t rev, revfmt, vers; 295 296 pvr = mfpvr(); 297 vers = pvr >> 16; 298 rev = pvr; 299 switch (vers) { 300 case MPC7410: 301 min = (pvr >> 0) & 0xff; 302 maj = min <= 4 ? 1 : 2; 303 break; 304 case FSL_E500v1: 305 case FSL_E500v2: 306 case FSL_E500mc: 307 case FSL_E5500: 308 maj = (pvr >> 4) & 0xf; 309 min = (pvr >> 0) & 0xf; 310 break; 311 default: 312 maj = (pvr >> 8) & 0xf; 313 min = (pvr >> 0) & 0xf; 314 } 315 316 revfmt = cput->revfmt; 317 name = cput->name; 318 if (rev == MPC750 && pvr == 15) { 319 name = "Motorola MPC755"; 320 revfmt = REVFMT_HEX; 321 } 322 strncpy(model, name, sizeof(model) - 1); 323 324 printf("cpu%d: %s revision ", cpuid, name); 325 326 switch (revfmt) { 327 case REVFMT_MAJMIN: 328 printf("%u.%u", maj, min); 329 break; 330 case REVFMT_HEX: 331 printf("0x%04x", rev); 332 break; 333 case REVFMT_DEC: 334 printf("%u", rev); 335 break; 336 } 337 338 if (cpu_est_clockrate(0, &cps) == 0) 339 printf(", %jd.%02jd MHz", cps / 1000000, (cps / 10000) % 100); 340 printf("\n"); 341 342 printf("cpu%d: Features %b\n", cpuid, (int)cpu_features, 343 PPC_FEATURE_BITMASK); 344 if (cpu_features2 != 0) 345 printf("cpu%d: Features2 %b\n", cpuid, (int)cpu_features2, 346 PPC_FEATURE2_BITMASK); 347 348 /* 349 * Configure CPU 350 */ 351 if (cput->cpu_setup != NULL) 352 cput->cpu_setup(cpuid, vers); 353 } 354 355 /* Get current clock frequency for the given cpu id. */ 356 int 357 cpu_est_clockrate(int cpu_id, uint64_t *cps) 358 { 359 uint16_t vers; 360 register_t msr; 361 phandle_t cpu, dev, root; 362 int res = 0; 363 char buf[8]; 364 365 vers = mfpvr() >> 16; 366 msr = mfmsr(); 367 mtmsr(msr & ~PSL_EE); 368 369 switch (vers) { 370 case MPC7450: 371 case MPC7455: 372 case MPC7457: 373 case MPC750: 374 case IBM750FX: 375 case MPC7400: 376 case MPC7410: 377 case MPC7447A: 378 case MPC7448: 379 mtspr(SPR_MMCR0, SPR_MMCR0_FC); 380 mtspr(SPR_PMC1, 0); 381 mtspr(SPR_MMCR0, SPR_MMCR0_PMC1SEL(PMCN_CYCLES)); 382 DELAY(1000); 383 *cps = (mfspr(SPR_PMC1) * 1000) + 4999; 384 mtspr(SPR_MMCR0, SPR_MMCR0_FC); 385 386 mtmsr(msr); 387 return (0); 388 case IBM970: 389 case IBM970FX: 390 case IBM970MP: 391 isync(); 392 mtspr(SPR_970MMCR0, SPR_MMCR0_FC); 393 isync(); 394 mtspr(SPR_970MMCR1, 0); 395 mtspr(SPR_970MMCRA, 0); 396 mtspr(SPR_970PMC1, 0); 397 mtspr(SPR_970MMCR0, 398 SPR_970MMCR0_PMC1SEL(PMC970N_CYCLES)); 399 isync(); 400 DELAY(1000); 401 powerpc_sync(); 402 mtspr(SPR_970MMCR0, SPR_MMCR0_FC); 403 *cps = (mfspr(SPR_970PMC1) * 1000) + 4999; 404 405 mtmsr(msr); 406 return (0); 407 408 default: 409 root = OF_peer(0); 410 if (root == 0) 411 return (ENXIO); 412 413 dev = OF_child(root); 414 while (dev != 0) { 415 res = OF_getprop(dev, "name", buf, sizeof(buf)); 416 if (res > 0 && strcmp(buf, "cpus") == 0) 417 break; 418 dev = OF_peer(dev); 419 } 420 cpu = OF_child(dev); 421 while (cpu != 0) { 422 res = OF_getprop(cpu, "device_type", buf, 423 sizeof(buf)); 424 if (res > 0 && strcmp(buf, "cpu") == 0) 425 break; 426 cpu = OF_peer(cpu); 427 } 428 if (cpu == 0) 429 return (ENOENT); 430 if (OF_getprop(cpu, "ibm,extended-clock-frequency", 431 cps, sizeof(*cps)) >= 0) { 432 return (0); 433 } else if (OF_getprop(cpu, "clock-frequency", cps, 434 sizeof(cell_t)) >= 0) { 435 *cps >>= 32; 436 return (0); 437 } else { 438 return (ENOENT); 439 } 440 } 441 } 442 443 void 444 cpu_6xx_setup(int cpuid, uint16_t vers) 445 { 446 register_t hid0, pvr; 447 const char *bitmask; 448 449 hid0 = mfspr(SPR_HID0); 450 pvr = mfpvr(); 451 452 /* 453 * Configure power-saving mode. 454 */ 455 switch (vers) { 456 case MPC603: 457 case MPC603e: 458 case MPC603ev: 459 case MPC604ev: 460 case MPC750: 461 case IBM750FX: 462 case MPC7400: 463 case MPC7410: 464 case MPC8240: 465 case MPC8245: 466 /* Select DOZE mode. */ 467 hid0 &= ~(HID0_DOZE | HID0_NAP | HID0_SLEEP); 468 hid0 |= HID0_DOZE | HID0_DPM; 469 powerpc_pow_enabled = 1; 470 break; 471 472 case MPC7448: 473 case MPC7447A: 474 case MPC7457: 475 case MPC7455: 476 case MPC7450: 477 /* Enable the 7450 branch caches */ 478 hid0 |= HID0_SGE | HID0_BTIC; 479 hid0 |= HID0_LRSTK | HID0_FOLD | HID0_BHT; 480 /* Disable BTIC on 7450 Rev 2.0 or earlier and on 7457 */ 481 if (((pvr >> 16) == MPC7450 && (pvr & 0xFFFF) <= 0x0200) 482 || (pvr >> 16) == MPC7457) 483 hid0 &= ~HID0_BTIC; 484 /* Select NAP mode. */ 485 hid0 &= ~(HID0_DOZE | HID0_NAP | HID0_SLEEP); 486 hid0 |= HID0_NAP | HID0_DPM; 487 powerpc_pow_enabled = 1; 488 break; 489 490 default: 491 /* No power-saving mode is available. */ ; 492 } 493 494 switch (vers) { 495 case IBM750FX: 496 case MPC750: 497 hid0 &= ~HID0_DBP; /* XXX correct? */ 498 hid0 |= HID0_EMCP | HID0_BTIC | HID0_SGE | HID0_BHT; 499 break; 500 501 case MPC7400: 502 case MPC7410: 503 hid0 &= ~HID0_SPD; 504 hid0 |= HID0_EMCP | HID0_BTIC | HID0_SGE | HID0_BHT; 505 hid0 |= HID0_EIEC; 506 break; 507 508 } 509 510 mtspr(SPR_HID0, hid0); 511 512 if (bootverbose) 513 cpu_6xx_print_cacheinfo(cpuid, vers); 514 515 switch (vers) { 516 case MPC7447A: 517 case MPC7448: 518 case MPC7450: 519 case MPC7455: 520 case MPC7457: 521 bitmask = HID0_7450_BITMASK; 522 break; 523 default: 524 bitmask = HID0_BITMASK; 525 break; 526 } 527 528 printf("cpu%d: HID0 %b\n", cpuid, (int)hid0, bitmask); 529 530 if (cpu_idle_hook == NULL) 531 cpu_idle_hook = cpu_idle_60x; 532 } 533 534 535 static void 536 cpu_6xx_print_cacheinfo(u_int cpuid, uint16_t vers) 537 { 538 register_t hid; 539 540 hid = mfspr(SPR_HID0); 541 printf("cpu%u: ", cpuid); 542 printf("L1 I-cache %sabled, ", (hid & HID0_ICE) ? "en" : "dis"); 543 printf("L1 D-cache %sabled\n", (hid & HID0_DCE) ? "en" : "dis"); 544 545 printf("cpu%u: ", cpuid); 546 if (mfspr(SPR_L2CR) & L2CR_L2E) { 547 switch (vers) { 548 case MPC7450: 549 case MPC7455: 550 case MPC7457: 551 printf("256KB L2 cache, "); 552 if (mfspr(SPR_L3CR) & L3CR_L3E) 553 printf("%cMB L3 backside cache", 554 mfspr(SPR_L3CR) & L3CR_L3SIZ ? '2' : '1'); 555 else 556 printf("L3 cache disabled"); 557 printf("\n"); 558 break; 559 case IBM750FX: 560 printf("512KB L2 cache\n"); 561 break; 562 default: 563 switch (mfspr(SPR_L2CR) & L2CR_L2SIZ) { 564 case L2SIZ_256K: 565 printf("256KB "); 566 break; 567 case L2SIZ_512K: 568 printf("512KB "); 569 break; 570 case L2SIZ_1M: 571 printf("1MB "); 572 break; 573 } 574 printf("write-%s", (mfspr(SPR_L2CR) & L2CR_L2WT) 575 ? "through" : "back"); 576 if (mfspr(SPR_L2CR) & L2CR_L2PE) 577 printf(", with parity"); 578 printf(" backside cache\n"); 579 break; 580 } 581 } else 582 printf("L2 cache disabled\n"); 583 } 584 585 static void 586 cpu_booke_setup(int cpuid, uint16_t vers) 587 { 588 #ifdef BOOKE_E500 589 register_t hid0; 590 const char *bitmask; 591 592 hid0 = mfspr(SPR_HID0); 593 594 switch (vers) { 595 case FSL_E500mc: 596 bitmask = HID0_E500MC_BITMASK; 597 cpu_idle_hook = cpu_idle_e500mc; 598 break; 599 case FSL_E5500: 600 case FSL_E6500: 601 bitmask = HID0_E5500_BITMASK; 602 cpu_idle_hook = cpu_idle_e500mc; 603 break; 604 case FSL_E500v1: 605 case FSL_E500v2: 606 /* Only e500v1/v2 support HID0 power management setup. */ 607 608 /* Program power-management mode. */ 609 hid0 &= ~(HID0_DOZE | HID0_NAP | HID0_SLEEP); 610 hid0 |= HID0_DOZE; 611 612 mtspr(SPR_HID0, hid0); 613 default: 614 bitmask = HID0_E500_BITMASK; 615 break; 616 } 617 printf("cpu%d: HID0 %b\n", cpuid, (int)hid0, bitmask); 618 #endif 619 620 if (cpu_idle_hook == NULL) 621 cpu_idle_hook = cpu_idle_booke; 622 } 623 624 static void 625 cpu_970_setup(int cpuid, uint16_t vers) 626 { 627 #ifdef AIM 628 uint32_t hid0_hi, hid0_lo; 629 630 __asm __volatile ("mfspr %0,%2; clrldi %1,%0,32; srdi %0,%0,32;" 631 : "=r" (hid0_hi), "=r" (hid0_lo) : "K" (SPR_HID0)); 632 633 /* Configure power-saving mode */ 634 switch (vers) { 635 case IBM970MP: 636 hid0_hi |= (HID0_DEEPNAP | HID0_NAP | HID0_DPM); 637 hid0_hi &= ~HID0_DOZE; 638 break; 639 default: 640 hid0_hi |= (HID0_NAP | HID0_DPM); 641 hid0_hi &= ~(HID0_DOZE | HID0_DEEPNAP); 642 break; 643 } 644 powerpc_pow_enabled = 1; 645 646 __asm __volatile (" \ 647 sync; isync; \ 648 sldi %0,%0,32; or %0,%0,%1; \ 649 mtspr %2, %0; \ 650 mfspr %0, %2; mfspr %0, %2; mfspr %0, %2; \ 651 mfspr %0, %2; mfspr %0, %2; mfspr %0, %2; \ 652 sync; isync" 653 :: "r" (hid0_hi), "r"(hid0_lo), "K" (SPR_HID0)); 654 655 __asm __volatile ("mfspr %0,%1; srdi %0,%0,32;" 656 : "=r" (hid0_hi) : "K" (SPR_HID0)); 657 printf("cpu%d: HID0 %b\n", cpuid, (int)(hid0_hi), HID0_970_BITMASK); 658 #endif 659 660 cpu_idle_hook = cpu_idle_60x; 661 } 662 663 static void 664 cpu_powerx_setup(int cpuid, uint16_t vers) 665 { 666 667 #if defined(__powerpc64__) && defined(AIM) 668 if ((mfmsr() & PSL_HV) == 0) 669 return; 670 671 /* Nuke the FSCR, to disable all facilities. */ 672 mtspr(SPR_FSCR, 0); 673 674 /* Configure power-saving */ 675 switch (vers) { 676 case IBMPOWER8: 677 case IBMPOWER8E: 678 case IBMPOWER8NVL: 679 cpu_idle_hook = cpu_idle_powerx; 680 mtspr(SPR_LPCR, mfspr(SPR_LPCR) | LPCR_PECE_WAKESET); 681 isync(); 682 break; 683 case IBMPOWER9: 684 cpu_idle_hook = cpu_idle_power9; 685 mtspr(SPR_LPCR, mfspr(SPR_LPCR) | LPCR_PECE_WAKESET); 686 isync(); 687 break; 688 default: 689 return; 690 } 691 692 #endif 693 } 694 695 static int 696 cpu_feature_bit(SYSCTL_HANDLER_ARGS) 697 { 698 int result; 699 700 result = (cpu_features & arg2) ? 1 : 0; 701 702 return (sysctl_handle_int(oidp, &result, 0, req)); 703 } 704 705 void 706 cpu_idle(int busy) 707 { 708 sbintime_t sbt = -1; 709 710 #ifdef INVARIANTS 711 if ((mfmsr() & PSL_EE) != PSL_EE) { 712 struct thread *td = curthread; 713 printf("td msr %#lx\n", (u_long)td->td_md.md_saved_msr); 714 panic("ints disabled in idleproc!"); 715 } 716 #endif 717 718 CTR2(KTR_SPARE2, "cpu_idle(%d) at %d", 719 busy, curcpu); 720 721 if (cpu_idle_hook != NULL) { 722 if (!busy) { 723 critical_enter(); 724 sbt = cpu_idleclock(); 725 } 726 cpu_idle_hook(sbt); 727 if (!busy) { 728 cpu_activeclock(); 729 critical_exit(); 730 } 731 } 732 733 CTR2(KTR_SPARE2, "cpu_idle(%d) at %d done", 734 busy, curcpu); 735 } 736 737 static void 738 cpu_idle_60x(sbintime_t sbt) 739 { 740 register_t msr; 741 uint16_t vers; 742 743 if (!powerpc_pow_enabled) 744 return; 745 746 msr = mfmsr(); 747 vers = mfpvr() >> 16; 748 749 #ifdef AIM 750 switch (vers) { 751 case IBM970: 752 case IBM970FX: 753 case IBM970MP: 754 case MPC7447A: 755 case MPC7448: 756 case MPC7450: 757 case MPC7455: 758 case MPC7457: 759 __asm __volatile("\ 760 dssall; sync; mtmsr %0; isync" 761 :: "r"(msr | PSL_POW)); 762 break; 763 default: 764 powerpc_sync(); 765 mtmsr(msr | PSL_POW); 766 break; 767 } 768 #endif 769 } 770 771 #ifdef BOOKE_E500 772 static void 773 cpu_idle_e500mc(sbintime_t sbt) 774 { 775 /* 776 * Base binutils doesn't know what the 'wait' instruction is, so 777 * use the opcode encoding here. 778 */ 779 __asm __volatile(".long 0x7c00007c"); 780 } 781 #endif 782 783 static void 784 cpu_idle_booke(sbintime_t sbt) 785 { 786 register_t msr; 787 788 msr = mfmsr(); 789 790 #ifdef BOOKE_E500 791 powerpc_sync(); 792 mtmsr(msr | PSL_WE); 793 #endif 794 } 795 796 #if defined(__powerpc64__) && defined(AIM) 797 static void 798 cpu_idle_powerx(sbintime_t sbt) 799 { 800 /* Sleeping when running on one cpu gives no advantages - avoid it */ 801 if (smp_started == 0) 802 return; 803 804 spinlock_enter(); 805 if (sched_runnable()) { 806 spinlock_exit(); 807 return; 808 } 809 810 if (can_wakeup == 0) 811 can_wakeup = 1; 812 mb(); 813 814 enter_idle_powerx(); 815 spinlock_exit(); 816 } 817 818 static void 819 cpu_idle_power9(sbintime_t sbt) 820 { 821 register_t msr; 822 823 msr = mfmsr(); 824 825 /* Suspend external interrupts until stop instruction completes. */ 826 mtmsr(msr & ~PSL_EE); 827 /* Set the stop state to lowest latency, wake up to next instruction */ 828 /* Set maximum transition level to 2, for deepest lossless sleep. */ 829 mtspr(SPR_PSSCR, (2 << PSSCR_MTL_S) | (0 << PSSCR_RL_S)); 830 /* "stop" instruction (PowerISA 3.0) */ 831 __asm __volatile (".long 0x4c0002e4"); 832 /* 833 * Re-enable external interrupts to capture the interrupt that caused 834 * the wake up. 835 */ 836 mtmsr(msr); 837 838 } 839 #endif 840 841 int 842 cpu_idle_wakeup(int cpu) 843 { 844 845 return (0); 846 } 847