2 * This file contains low level CPU setup functions.
3 * Copyright (C) 2003 Benjamin Herrenschmidt (benh@kernel.crashing.org)
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * as published by the Free Software Foundation; either version
8 * 2 of the License, or (at your option) any later version.
12 #include <asm/processor.h>
14 #include <asm/cputable.h>
15 #include <asm/ppc_asm.h>
16 #include <asm/asm-offsets.h>
17 #include <asm/cache.h>
20 _GLOBAL(__setup_cpu_603)
24 mtspr SPRN_SPRG_603_LRU,r10 /* init SW LRU tracking */
25 END_MMU_FTR_SECTION_IFSET(MMU_FTR_NEED_DTLB_SW_LRU)
27 bl __init_fpu_registers
28 END_FTR_SECTION_IFCLR(CPU_FTR_FPU_UNAVAILABLE)
29 bl setup_common_caches
32 _GLOBAL(__setup_cpu_604)
34 bl setup_common_caches
38 _GLOBAL(__setup_cpu_750)
40 bl __init_fpu_registers
41 bl setup_common_caches
42 bl setup_750_7400_hid0
45 _GLOBAL(__setup_cpu_750cx)
47 bl __init_fpu_registers
48 bl setup_common_caches
49 bl setup_750_7400_hid0
53 _GLOBAL(__setup_cpu_750fx)
55 bl __init_fpu_registers
56 bl setup_common_caches
57 bl setup_750_7400_hid0
61 _GLOBAL(__setup_cpu_7400)
63 bl __init_fpu_registers
64 bl setup_7400_workarounds
65 bl setup_common_caches
66 bl setup_750_7400_hid0
69 _GLOBAL(__setup_cpu_7410)
71 bl __init_fpu_registers
72 bl setup_7410_workarounds
73 bl setup_common_caches
74 bl setup_750_7400_hid0
79 _GLOBAL(__setup_cpu_745x)
81 bl setup_common_caches
82 bl setup_745x_specifics
86 /* Enable caches for 603's, 604, 750 & 7400 */
90 ori r11,r11,HID0_ICE|HID0_DCE
92 bne 1f /* don't invalidate the D-cache */
93 ori r8,r8,HID0_DCI /* unless it wasn't enabled */
95 mtspr SPRN_HID0,r8 /* enable and invalidate caches */
97 mtspr SPRN_HID0,r11 /* enable caches */
102 /* 604, 604e, 604ev, ...
103 * Enable superscalar execution & branch history table
107 ori r11,r11,HID0_SIED|HID0_BHTE
110 mtspr SPRN_HID0,r8 /* flush branch target address cache */
111 sync /* on 604e/604r */
117 setup_7400_workarounds:
123 setup_7410_workarounds:
129 mfspr r11,SPRN_MSSSR0
130 /* Errata #3: Set L1OPQ_SIZE to 0x10 */
133 /* Errata #4: Set L2MQ_SIZE to 1 (check for MPX mode first ?) */
135 /* Errata #5: Set DRLT_SIZE to 0x01 */
139 mtspr SPRN_MSSSR0,r11
145 * Enable Store Gathering (SGE), Address Brodcast (ABE),
146 * Branch History Table (BHTE), Branch Target ICache (BTIC)
147 * Dynamic Power Management (DPM), Speculative (SPD)
148 * Clear Instruction cache throttling (ICTC)
152 ori r11,r11,HID0_SGE | HID0_ABE | HID0_BHTE | HID0_BTIC
153 oris r11,r11,HID0_DPM@h
155 xori r11,r11,HID0_BTIC
156 END_FTR_SECTION_IFSET(CPU_FTR_NO_BTIC)
158 xoris r11,r11,HID0_DPM@h /* disable dynamic power mgmt */
159 END_FTR_SECTION_IFSET(CPU_FTR_NO_DPM)
161 andc r11,r11,r3 /* clear SPD: enable speculative */
163 mtspr SPRN_ICTC,r3 /* Instruction Cache Throttling off */
171 * Looks like we have to disable NAP feature for some PLL settings...
172 * (waiting for confirmation)
176 rlwinm r10,r10,4,28,31
180 cror 4*cr0+eq,4*cr0+eq,4*cr1+eq
181 cror 4*cr0+eq,4*cr0+eq,4*cr2+eq
183 lwz r6,CPU_SPEC_FEATURES(r4)
184 li r7,CPU_FTR_CAN_NAP
186 stw r6,CPU_SPEC_FEATURES(r4)
195 * Enable Store Gathering (SGE), Branch Folding (FOLD)
196 * Branch History Table (BHTE), Branch Target ICache (BTIC)
197 * Dynamic Power Management (DPM), Speculative (SPD)
198 * Ensure our data cache instructions really operate.
199 * Timebase has to be running or we wouldn't have made it here,
200 * just ensure we don't disable it.
201 * Clear Instruction cache throttling (ICTC)
202 * Enable L2 HW prefetch
204 setup_745x_specifics:
205 /* We check for the presence of an L3 cache setup by
206 * the firmware. If any, we disable NAP capability as
207 * it's known to be bogus on rev 2.1 and earlier
211 andis. r11,r11,L3CR_L3E@h
213 END_FTR_SECTION_IFSET(CPU_FTR_L3CR)
214 lwz r6,CPU_SPEC_FEATURES(r4)
215 andi. r0,r6,CPU_FTR_L3_DISABLE_NAP
217 li r7,CPU_FTR_CAN_NAP
219 stw r6,CPU_SPEC_FEATURES(r4)
223 /* All of the bits we have to set.....
225 ori r11,r11,HID0_SGE | HID0_FOLD | HID0_BHTE
226 ori r11,r11,HID0_LRSTK | HID0_BTIC
227 oris r11,r11,HID0_DPM@h
228 BEGIN_MMU_FTR_SECTION
229 oris r11,r11,HID0_HIGH_BAT@h
230 END_MMU_FTR_SECTION_IFSET(MMU_FTR_USE_HIGH_BATS)
232 xori r11,r11,HID0_BTIC
233 END_FTR_SECTION_IFSET(CPU_FTR_NO_BTIC)
235 xoris r11,r11,HID0_DPM@h /* disable dynamic power mgmt */
236 END_FTR_SECTION_IFSET(CPU_FTR_NO_DPM)
238 /* All of the bits we have to clear....
240 li r3,HID0_SPD | HID0_NOPDST | HID0_NOPTI
241 andc r11,r11,r3 /* clear SPD: enable speculative */
244 mtspr SPRN_ICTC,r3 /* Instruction Cache Throttling off */
250 /* Enable L2 HW prefetch, if L2 is enabled
253 andis. r3,r3,L2CR_L2E@h
263 _GLOBAL(__init_fpu_registers)
268 addis r9,r3,empty_zero_page@ha
269 addi r9,r9,empty_zero_page@l
277 /* Definitions for the table use to save CPU states */
289 .balign L1_CACHE_BYTES
292 .balign L1_CACHE_BYTES,0
295 /* Called in normal context to backup CPU 0 state. This
296 * does not include cache settings. This function is also
297 * called for machine sleep. This does not include the MMU
298 * setup, BATs, etc... but rather the "special" registers
299 * like HID0, HID1, MSSCR0, etc...
301 _GLOBAL(__save_cpu_setup)
302 /* Some CR fields are volatile, we back it up all */
305 /* Get storage ptr */
306 lis r5,cpu_state_storage@h
307 ori r5,r5,cpu_state_storage@l
309 /* Save HID0 (common to all CONFIG_6xx cpus) */
313 /* Now deal with CPU type dependent registers */
316 cmplwi cr0,r3,0x8000 /* 7450 */
317 cmplwi cr1,r3,0x000c /* 7400 */
318 cmplwi cr2,r3,0x800c /* 7410 */
319 cmplwi cr3,r3,0x8001 /* 7455 */
320 cmplwi cr4,r3,0x8002 /* 7457 */
321 cmplwi cr5,r3,0x8003 /* 7447A */
322 cmplwi cr6,r3,0x7000 /* 750FX */
323 cmplwi cr7,r3,0x8004 /* 7448 */
324 /* cr1 is 7400 || 7410 */
325 cror 4*cr1+eq,4*cr1+eq,4*cr2+eq
327 cror 4*cr0+eq,4*cr0+eq,4*cr3+eq
328 cror 4*cr0+eq,4*cr0+eq,4*cr4+eq
329 cror 4*cr0+eq,4*cr0+eq,4*cr1+eq
330 cror 4*cr0+eq,4*cr0+eq,4*cr5+eq
331 cror 4*cr0+eq,4*cr0+eq,4*cr7+eq
333 /* Backup 74xx specific regs */
339 /* Backup 745x specific registers */
350 /* Backup 750FX specific registers */
353 /* If rev 2.x, backup HID2 */
364 /* Called with no MMU context (typically MSR:IR/DR off) to
365 * restore CPU state as backed up by the previous
366 * function. This does not include cache setting
368 _GLOBAL(__restore_cpu_setup)
369 /* Some CR fields are volatile, we back it up all */
372 /* Get storage ptr */
373 lis r5,(cpu_state_storage-KERNELBASE)@h
374 ori r5,r5,cpu_state_storage@l
384 /* Now deal with CPU type dependent registers */
387 cmplwi cr0,r3,0x8000 /* 7450 */
388 cmplwi cr1,r3,0x000c /* 7400 */
389 cmplwi cr2,r3,0x800c /* 7410 */
390 cmplwi cr3,r3,0x8001 /* 7455 */
391 cmplwi cr4,r3,0x8002 /* 7457 */
392 cmplwi cr5,r3,0x8003 /* 7447A */
393 cmplwi cr6,r3,0x7000 /* 750FX */
394 cmplwi cr7,r3,0x8004 /* 7448 */
395 /* cr1 is 7400 || 7410 */
396 cror 4*cr1+eq,4*cr1+eq,4*cr2+eq
398 cror 4*cr0+eq,4*cr0+eq,4*cr3+eq
399 cror 4*cr0+eq,4*cr0+eq,4*cr4+eq
400 cror 4*cr0+eq,4*cr0+eq,4*cr1+eq
401 cror 4*cr0+eq,4*cr0+eq,4*cr5+eq
402 cror 4*cr0+eq,4*cr0+eq,4*cr7+eq
404 /* Restore 74xx specific regs */
416 /* Clear 7410 L2CR2 */
420 /* Restore 745x specific registers */
442 /* Restore 750FX specific registers
443 * that is restore HID2 on rev 2.x and PLL config & switch
446 /* If rev 2.x, restore HID2 with low voltage bit cleared */
459 /* Wait for PLL to stabilize */
465 /* Setup final PLL */