1/* SPDX-License-Identifier: GPL-2.0-or-later */ 2/* 3 * This file contains low level CPU setup functions. 4 * Copyright (C) 2003 Benjamin Herrenschmidt (benh@kernel.crashing.org) 5 */ 6 7#include <linux/linkage.h> 8 9#include <asm/processor.h> 10#include <asm/page.h> 11#include <asm/cputable.h> 12#include <asm/ppc_asm.h> 13#include <asm/asm-offsets.h> 14#include <asm/cache.h> 15#include <asm/mmu.h> 16#include <asm/feature-fixups.h> 17 18_GLOBAL(__setup_cpu_603) 19 mflr r5 20BEGIN_MMU_FTR_SECTION 21 li r10,0 22 mtspr SPRN_SPRG_603_LRU,r10 /* init SW LRU tracking */ 23END_MMU_FTR_SECTION_IFSET(MMU_FTR_NEED_DTLB_SW_LRU) 24 25BEGIN_FTR_SECTION 26 bl __init_fpu_registers 27END_FTR_SECTION_IFCLR(CPU_FTR_FPU_UNAVAILABLE) 28 bl setup_common_caches 29 mtlr r5 30 blr 31_GLOBAL(__setup_cpu_604) 32 mflr r5 33 bl setup_common_caches 34 bl setup_604_hid0 35 mtlr r5 36 blr 37_GLOBAL(__setup_cpu_750) 38 mflr r5 39 bl __init_fpu_registers 40 bl setup_common_caches 41 bl setup_750_7400_hid0 42 mtlr r5 43 blr 44_GLOBAL(__setup_cpu_750cx) 45 mflr r5 46 bl __init_fpu_registers 47 bl setup_common_caches 48 bl setup_750_7400_hid0 49 bl setup_750cx 50 mtlr r5 51 blr 52_GLOBAL(__setup_cpu_750fx) 53 mflr r5 54 bl __init_fpu_registers 55 bl setup_common_caches 56 bl setup_750_7400_hid0 57 bl setup_750fx 58 mtlr r5 59 blr 60_GLOBAL(__setup_cpu_7400) 61 mflr r5 62 bl __init_fpu_registers 63 bl setup_7400_workarounds 64 bl setup_common_caches 65 bl setup_750_7400_hid0 66 mtlr r5 67 blr 68_GLOBAL(__setup_cpu_7410) 69 mflr r5 70 bl __init_fpu_registers 71 bl setup_7410_workarounds 72 bl setup_common_caches 73 bl setup_750_7400_hid0 74 li r3,0 75 mtspr SPRN_L2CR2,r3 76 mtlr r5 77 blr 78_GLOBAL(__setup_cpu_745x) 79 mflr r5 80 bl setup_common_caches 81 bl setup_745x_specifics 82 mtlr r5 83 blr 84 85/* Enable caches for 603's, 604, 750 & 7400 */ 86SYM_FUNC_START_LOCAL(setup_common_caches) 87 mfspr r11,SPRN_HID0 88 andi. r0,r11,HID0_DCE 89 ori r11,r11,HID0_ICE|HID0_DCE 90 ori r8,r11,HID0_ICFI 91 bne 1f /* don't invalidate the D-cache */ 92 ori r8,r8,HID0_DCI /* unless it wasn't enabled */ 931: sync 94 mtspr SPRN_HID0,r8 /* enable and invalidate caches */ 95 sync 96 mtspr SPRN_HID0,r11 /* enable caches */ 97 sync 98 isync 99 blr 100SYM_FUNC_END(setup_common_caches) 101 102/* 604, 604e, 604ev, ... 103 * Enable superscalar execution & branch history table 104 */ 105SYM_FUNC_START_LOCAL(setup_604_hid0) 106 mfspr r11,SPRN_HID0 107 ori r11,r11,HID0_SIED|HID0_BHTE 108 ori r8,r11,HID0_BTCD 109 sync 110 mtspr SPRN_HID0,r8 /* flush branch target address cache */ 111 sync /* on 604e/604r */ 112 mtspr SPRN_HID0,r11 113 sync 114 isync 115 blr 116SYM_FUNC_END(setup_604_hid0) 117 118/* 7400 <= rev 2.7 and 7410 rev = 1.0 suffer from some 119 * erratas we work around here. 120 * Moto MPC710CE.pdf describes them, those are errata 121 * #3, #4 and #5 122 * Note that we assume the firmware didn't choose to 123 * apply other workarounds (there are other ones documented 124 * in the .pdf). It appear that Apple firmware only works 125 * around #3 and with the same fix we use. We may want to 126 * check if the CPU is using 60x bus mode in which case 127 * the workaround for errata #4 is useless. Also, we may 128 * want to explicitly clear HID0_NOPDST as this is not 129 * needed once we have applied workaround #5 (though it's 130 * not set by Apple's firmware at least). 131 */ 132SYM_FUNC_START_LOCAL(setup_7400_workarounds) 133 mfpvr r3 134 rlwinm r3,r3,0,20,31 135 cmpwi 0,r3,0x0207 136 ble 1f 137 blr 138SYM_FUNC_END(setup_7400_workarounds) 139SYM_FUNC_START_LOCAL(setup_7410_workarounds) 140 mfpvr r3 141 rlwinm r3,r3,0,20,31 142 cmpwi 0,r3,0x0100 143 bnelr 1441: 145 mfspr r11,SPRN_MSSSR0 146 /* Errata #3: Set L1OPQ_SIZE to 0x10 */ 147 rlwinm r11,r11,0,9,6 148 oris r11,r11,0x0100 149 /* Errata #4: Set L2MQ_SIZE to 1 (check for MPX mode first ?) */ 150 oris r11,r11,0x0002 151 /* Errata #5: Set DRLT_SIZE to 0x01 */ 152 rlwinm r11,r11,0,5,2 153 oris r11,r11,0x0800 154 sync 155 mtspr SPRN_MSSSR0,r11 156 sync 157 isync 158 blr 159SYM_FUNC_END(setup_7410_workarounds) 160 161/* 740/750/7400/7410 162 * Enable Store Gathering (SGE), Address Broadcast (ABE), 163 * Branch History Table (BHTE), Branch Target ICache (BTIC) 164 * Dynamic Power Management (DPM), Speculative (SPD) 165 * Clear Instruction cache throttling (ICTC) 166 */ 167SYM_FUNC_START_LOCAL(setup_750_7400_hid0) 168 mfspr r11,SPRN_HID0 169 ori r11,r11,HID0_SGE | HID0_ABE | HID0_BHTE | HID0_BTIC 170 oris r11,r11,HID0_DPM@h 171BEGIN_FTR_SECTION 172 xori r11,r11,HID0_BTIC 173END_FTR_SECTION_IFSET(CPU_FTR_NO_BTIC) 174BEGIN_FTR_SECTION 175 xoris r11,r11,HID0_DPM@h /* disable dynamic power mgmt */ 176END_FTR_SECTION_IFSET(CPU_FTR_NO_DPM) 177 li r3,HID0_SPD 178 andc r11,r11,r3 /* clear SPD: enable speculative */ 179 li r3,0 180 mtspr SPRN_ICTC,r3 /* Instruction Cache Throttling off */ 181 isync 182 mtspr SPRN_HID0,r11 183 sync 184 isync 185 blr 186SYM_FUNC_END(setup_750_7400_hid0) 187 188/* 750cx specific 189 * Looks like we have to disable NAP feature for some PLL settings... 190 * (waiting for confirmation) 191 */ 192SYM_FUNC_START_LOCAL(setup_750cx) 193 mfspr r10, SPRN_HID1 194 rlwinm r10,r10,4,28,31 195 cmpwi cr0,r10,7 196 cmpwi cr1,r10,9 197 cmpwi cr2,r10,11 198 cror 4*cr0+eq,4*cr0+eq,4*cr1+eq 199 cror 4*cr0+eq,4*cr0+eq,4*cr2+eq 200 bnelr 201 lwz r6,CPU_SPEC_FEATURES(r4) 202 li r7,CPU_FTR_CAN_NAP 203 andc r6,r6,r7 204 stw r6,CPU_SPEC_FEATURES(r4) 205 blr 206SYM_FUNC_END(setup_750cx) 207 208/* 750fx specific 209 */ 210SYM_FUNC_START_LOCAL(setup_750fx) 211 blr 212SYM_FUNC_END(setup_750fx) 213 214/* MPC 745x 215 * Enable Store Gathering (SGE), Branch Folding (FOLD) 216 * Branch History Table (BHTE), Branch Target ICache (BTIC) 217 * Dynamic Power Management (DPM), Speculative (SPD) 218 * Ensure our data cache instructions really operate. 219 * Timebase has to be running or we wouldn't have made it here, 220 * just ensure we don't disable it. 221 * Clear Instruction cache throttling (ICTC) 222 * Enable L2 HW prefetch 223 */ 224SYM_FUNC_START_LOCAL(setup_745x_specifics) 225 /* We check for the presence of an L3 cache setup by 226 * the firmware. If any, we disable NAP capability as 227 * it's known to be bogus on rev 2.1 and earlier 228 */ 229BEGIN_FTR_SECTION 230 mfspr r11,SPRN_L3CR 231 andis. r11,r11,L3CR_L3E@h 232 beq 1f 233END_FTR_SECTION_IFSET(CPU_FTR_L3CR) 234 lwz r6,CPU_SPEC_FEATURES(r4) 235 andis. r0,r6,CPU_FTR_L3_DISABLE_NAP@h 236 beq 1f 237 li r7,CPU_FTR_CAN_NAP 238 andc r6,r6,r7 239 stw r6,CPU_SPEC_FEATURES(r4) 2401: 241 mfspr r11,SPRN_HID0 242 243 /* All of the bits we have to set..... 244 */ 245 ori r11,r11,HID0_SGE | HID0_FOLD | HID0_BHTE 246 ori r11,r11,HID0_LRSTK | HID0_BTIC 247 oris r11,r11,HID0_DPM@h 248BEGIN_MMU_FTR_SECTION 249 oris r11,r11,HID0_HIGH_BAT@h 250END_MMU_FTR_SECTION_IFSET(MMU_FTR_USE_HIGH_BATS) 251BEGIN_FTR_SECTION 252 xori r11,r11,HID0_BTIC 253END_FTR_SECTION_IFSET(CPU_FTR_NO_BTIC) 254BEGIN_FTR_SECTION 255 xoris r11,r11,HID0_DPM@h /* disable dynamic power mgmt */ 256END_FTR_SECTION_IFSET(CPU_FTR_NO_DPM) 257 258 /* All of the bits we have to clear.... 259 */ 260 li r3,HID0_SPD | HID0_NOPDST | HID0_NOPTI 261 andc r11,r11,r3 /* clear SPD: enable speculative */ 262 li r3,0 263 264 mtspr SPRN_ICTC,r3 /* Instruction Cache Throttling off */ 265 isync 266 mtspr SPRN_HID0,r11 267 sync 268 isync 269 270 /* Enable L2 HW prefetch, if L2 is enabled 271 */ 272 mfspr r3,SPRN_L2CR 273 andis. r3,r3,L2CR_L2E@h 274 beqlr 275 mfspr r3,SPRN_MSSCR0 276 ori r3,r3,3 277 sync 278 mtspr SPRN_MSSCR0,r3 279 sync 280 isync 281 blr 282SYM_FUNC_END(setup_745x_specifics) 283 284/* 285 * Initialize the FPU registers. This is needed to work around an errata 286 * in some 750 cpus where using a not yet initialized FPU register after 287 * power on reset may hang the CPU 288 */ 289_GLOBAL(__init_fpu_registers) 290 mfmsr r10 291 ori r11,r10,MSR_FP 292 mtmsr r11 293 isync 294 addis r9,r3,empty_zero_page@ha 295 addi r9,r9,empty_zero_page@l 296 REST_32FPRS(0,r9) 297 sync 298 mtmsr r10 299 isync 300 blr 301_ASM_NOKPROBE_SYMBOL(__init_fpu_registers) 302 303 304/* Definitions for the table use to save CPU states */ 305#define CS_HID0 0 306#define CS_HID1 4 307#define CS_HID2 8 308#define CS_MSSCR0 12 309#define CS_MSSSR0 16 310#define CS_ICTRL 20 311#define CS_LDSTCR 24 312#define CS_LDSTDB 28 313#define CS_SIZE 32 314 315 .data 316 .balign L1_CACHE_BYTES 317cpu_state_storage: 318 .space CS_SIZE 319 .balign L1_CACHE_BYTES,0 320 .text 321 322/* Called in normal context to backup CPU 0 state. This 323 * does not include cache settings. This function is also 324 * called for machine sleep. This does not include the MMU 325 * setup, BATs, etc... but rather the "special" registers 326 * like HID0, HID1, MSSCR0, etc... 327 */ 328_GLOBAL(__save_cpu_setup) 329 /* Some CR fields are volatile, we back it up all */ 330 mfcr r7 331 332 /* Get storage ptr */ 333 lis r5,cpu_state_storage@h 334 ori r5,r5,cpu_state_storage@l 335 336 /* Save HID0 (common to all CONFIG_PPC_BOOK3S_32 cpus) */ 337 mfspr r3,SPRN_HID0 338 stw r3,CS_HID0(r5) 339 340 /* Now deal with CPU type dependent registers */ 341 mfspr r3,SPRN_PVR 342 srwi r3,r3,16 343 cmplwi cr0,r3,0x8000 /* 7450 */ 344 cmplwi cr1,r3,0x000c /* 7400 */ 345 cmplwi cr2,r3,0x800c /* 7410 */ 346 cmplwi cr3,r3,0x8001 /* 7455 */ 347 cmplwi cr4,r3,0x8002 /* 7457 */ 348 cmplwi cr5,r3,0x8003 /* 7447A */ 349 cmplwi cr6,r3,0x7000 /* 750FX */ 350 cmplwi cr7,r3,0x8004 /* 7448 */ 351 /* cr1 is 7400 || 7410 */ 352 cror 4*cr1+eq,4*cr1+eq,4*cr2+eq 353 /* cr0 is 74xx */ 354 cror 4*cr0+eq,4*cr0+eq,4*cr3+eq 355 cror 4*cr0+eq,4*cr0+eq,4*cr4+eq 356 cror 4*cr0+eq,4*cr0+eq,4*cr1+eq 357 cror 4*cr0+eq,4*cr0+eq,4*cr5+eq 358 cror 4*cr0+eq,4*cr0+eq,4*cr7+eq 359 bne 1f 360 /* Backup 74xx specific regs */ 361 mfspr r4,SPRN_MSSCR0 362 stw r4,CS_MSSCR0(r5) 363 mfspr r4,SPRN_MSSSR0 364 stw r4,CS_MSSSR0(r5) 365 beq cr1,1f 366 /* Backup 745x specific registers */ 367 mfspr r4,SPRN_HID1 368 stw r4,CS_HID1(r5) 369 mfspr r4,SPRN_ICTRL 370 stw r4,CS_ICTRL(r5) 371 mfspr r4,SPRN_LDSTCR 372 stw r4,CS_LDSTCR(r5) 373 mfspr r4,SPRN_LDSTDB 374 stw r4,CS_LDSTDB(r5) 3751: 376 bne cr6,1f 377 /* Backup 750FX specific registers */ 378 mfspr r4,SPRN_HID1 379 stw r4,CS_HID1(r5) 380 /* If rev 2.x, backup HID2 */ 381 mfspr r3,SPRN_PVR 382 andi. r3,r3,0xff00 383 cmpwi cr0,r3,0x0200 384 bne 1f 385 mfspr r4,SPRN_HID2 386 stw r4,CS_HID2(r5) 3871: 388 mtcr r7 389 blr 390 391/* Called with no MMU context (typically MSR:IR/DR off) to 392 * restore CPU state as backed up by the previous 393 * function. This does not include cache setting 394 */ 395_GLOBAL(__restore_cpu_setup) 396 /* Some CR fields are volatile, we back it up all */ 397 mfcr r7 398 399 /* Get storage ptr */ 400 lis r5,(cpu_state_storage-KERNELBASE)@h 401 ori r5,r5,cpu_state_storage@l 402 403 /* Restore HID0 */ 404 lwz r3,CS_HID0(r5) 405 sync 406 isync 407 mtspr SPRN_HID0,r3 408 sync 409 isync 410 411 /* Now deal with CPU type dependent registers */ 412 mfspr r3,SPRN_PVR 413 srwi r3,r3,16 414 cmplwi cr0,r3,0x8000 /* 7450 */ 415 cmplwi cr1,r3,0x000c /* 7400 */ 416 cmplwi cr2,r3,0x800c /* 7410 */ 417 cmplwi cr3,r3,0x8001 /* 7455 */ 418 cmplwi cr4,r3,0x8002 /* 7457 */ 419 cmplwi cr5,r3,0x8003 /* 7447A */ 420 cmplwi cr6,r3,0x7000 /* 750FX */ 421 cmplwi cr7,r3,0x8004 /* 7448 */ 422 /* cr1 is 7400 || 7410 */ 423 cror 4*cr1+eq,4*cr1+eq,4*cr2+eq 424 /* cr0 is 74xx */ 425 cror 4*cr0+eq,4*cr0+eq,4*cr3+eq 426 cror 4*cr0+eq,4*cr0+eq,4*cr4+eq 427 cror 4*cr0+eq,4*cr0+eq,4*cr1+eq 428 cror 4*cr0+eq,4*cr0+eq,4*cr5+eq 429 cror 4*cr0+eq,4*cr0+eq,4*cr7+eq 430 bne 2f 431 /* Restore 74xx specific regs */ 432 lwz r4,CS_MSSCR0(r5) 433 sync 434 mtspr SPRN_MSSCR0,r4 435 sync 436 isync 437 lwz r4,CS_MSSSR0(r5) 438 sync 439 mtspr SPRN_MSSSR0,r4 440 sync 441 isync 442 bne cr2,1f 443 /* Clear 7410 L2CR2 */ 444 li r4,0 445 mtspr SPRN_L2CR2,r4 4461: beq cr1,2f 447 /* Restore 745x specific registers */ 448 lwz r4,CS_HID1(r5) 449 sync 450 mtspr SPRN_HID1,r4 451 isync 452 sync 453 lwz r4,CS_ICTRL(r5) 454 sync 455 mtspr SPRN_ICTRL,r4 456 isync 457 sync 458 lwz r4,CS_LDSTCR(r5) 459 sync 460 mtspr SPRN_LDSTCR,r4 461 isync 462 sync 463 lwz r4,CS_LDSTDB(r5) 464 sync 465 mtspr SPRN_LDSTDB,r4 466 isync 467 sync 4682: bne cr6,1f 469 /* Restore 750FX specific registers 470 * that is restore HID2 on rev 2.x and PLL config & switch 471 * to PLL 0 on all 472 */ 473 /* If rev 2.x, restore HID2 with low voltage bit cleared */ 474 mfspr r3,SPRN_PVR 475 andi. r3,r3,0xff00 476 cmpwi cr0,r3,0x0200 477 bne 4f 478 lwz r4,CS_HID2(r5) 479 rlwinm r4,r4,0,19,17 480 mtspr SPRN_HID2,r4 481 sync 4824: 483 lwz r4,CS_HID1(r5) 484 rlwinm r5,r4,0,16,14 485 mtspr SPRN_HID1,r5 486 /* Wait for PLL to stabilize */ 487 mftbl r5 4883: mftbl r6 489 sub r6,r6,r5 490 cmplwi cr0,r6,10000 491 ble 3b 492 /* Setup final PLL */ 493 mtspr SPRN_HID1,r4 4941: 495 mtcr r7 496 blr 497_ASM_NOKPROBE_SYMBOL(__restore_cpu_setup) 498 499
