Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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) 1994, 1995 Waldorf Electronics |
| 7 | * Written by Ralf Baechle and Andreas Busse |
Ralf Baechle | 192ef36 | 2006-07-07 14:07:18 +0100 | [diff] [blame] | 8 | * Copyright (C) 1994 - 99, 2003, 06 Ralf Baechle |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | * Copyright (C) 1996 Paul M. Antoine |
| 10 | * Modified for DECStation and hence R3000 support by Paul M. Antoine |
| 11 | * Further modifications by David S. Miller and Harald Koerfgen |
| 12 | * Copyright (C) 1999 Silicon Graphics, Inc. |
| 13 | * Kevin Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com |
| 14 | * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved. |
| 15 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/init.h> |
| 17 | #include <linux/threads.h> |
| 18 | |
Marc St-Jean | 9267a30 | 2007-06-14 15:55:31 -0600 | [diff] [blame] | 19 | #include <asm/addrspace.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #include <asm/asm.h> |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 21 | #include <asm/asmmacro.h> |
Ralf Baechle | 192ef36 | 2006-07-07 14:07:18 +0100 | [diff] [blame] | 22 | #include <asm/irqflags.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | #include <asm/regdef.h> |
| 24 | #include <asm/page.h> |
| 25 | #include <asm/mipsregs.h> |
| 26 | #include <asm/stackframe.h> |
Ralf Baechle | 7e35952 | 2005-07-14 09:42:32 +0000 | [diff] [blame] | 27 | |
| 28 | #include <kernel-entry-init.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | /* |
| 31 | * inputs are the text nasid in t1, data nasid in t2. |
| 32 | */ |
| 33 | .macro MAPPED_KERNEL_SETUP_TLB |
| 34 | #ifdef CONFIG_MAPPED_KERNEL |
| 35 | /* |
| 36 | * This needs to read the nasid - assume 0 for now. |
| 37 | * Drop in 0xffffffffc0000000 in tlbhi, 0+VG in tlblo_0, |
| 38 | * 0+DVG in tlblo_1. |
| 39 | */ |
| 40 | dli t0, 0xffffffffc0000000 |
| 41 | dmtc0 t0, CP0_ENTRYHI |
| 42 | li t0, 0x1c000 # Offset of text into node memory |
| 43 | dsll t1, NASID_SHFT # Shift text nasid into place |
| 44 | dsll t2, NASID_SHFT # Same for data nasid |
| 45 | or t1, t1, t0 # Physical load address of kernel text |
| 46 | or t2, t2, t0 # Physical load address of kernel data |
| 47 | dsrl t1, 12 # 4K pfn |
| 48 | dsrl t2, 12 # 4K pfn |
| 49 | dsll t1, 6 # Get pfn into place |
| 50 | dsll t2, 6 # Get pfn into place |
| 51 | li t0, ((_PAGE_GLOBAL|_PAGE_VALID| _CACHE_CACHABLE_COW) >> 6) |
| 52 | or t0, t0, t1 |
| 53 | mtc0 t0, CP0_ENTRYLO0 # physaddr, VG, cach exlwr |
| 54 | li t0, ((_PAGE_GLOBAL|_PAGE_VALID| _PAGE_DIRTY|_CACHE_CACHABLE_COW) >> 6) |
| 55 | or t0, t0, t2 |
| 56 | mtc0 t0, CP0_ENTRYLO1 # physaddr, DVG, cach exlwr |
| 57 | li t0, 0x1ffe000 # MAPPED_KERN_TLBMASK, TLBPGMASK_16M |
| 58 | mtc0 t0, CP0_PAGEMASK |
| 59 | li t0, 0 # KMAP_INX |
| 60 | mtc0 t0, CP0_INDEX |
| 61 | li t0, 1 |
| 62 | mtc0 t0, CP0_WIRED |
| 63 | tlbwi |
| 64 | #else |
| 65 | mtc0 zero, CP0_WIRED |
| 66 | #endif |
| 67 | .endm |
| 68 | |
| 69 | /* |
| 70 | * For the moment disable interrupts, mark the kernel mode and |
| 71 | * set ST0_KX so that the CPU does not spit fire when using |
| 72 | * 64-bit addresses. A full initialization of the CPU's status |
| 73 | * register is done later in per_cpu_trap_init(). |
| 74 | */ |
| 75 | .macro setup_c0_status set clr |
| 76 | .set push |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 77 | #ifdef CONFIG_MIPS_MT_SMTC |
| 78 | /* |
| 79 | * For SMTC, we need to set privilege and disable interrupts only for |
| 80 | * the current TC, using the TCStatus register. |
| 81 | */ |
| 82 | mfc0 t0, CP0_TCSTATUS |
| 83 | /* Fortunately CU 0 is in the same place in both registers */ |
| 84 | /* Set TCU0, TMX, TKSU (for later inversion) and IXMT */ |
| 85 | li t1, ST0_CU0 | 0x08001c00 |
| 86 | or t0, t1 |
| 87 | /* Clear TKSU, leave IXMT */ |
| 88 | xori t0, 0x00001800 |
| 89 | mtc0 t0, CP0_TCSTATUS |
Ralf Baechle | 4277ff5 | 2006-06-03 22:40:15 +0100 | [diff] [blame] | 90 | _ehb |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 91 | /* We need to leave the global IE bit set, but clear EXL...*/ |
| 92 | mfc0 t0, CP0_STATUS |
| 93 | or t0, ST0_CU0 | ST0_EXL | ST0_ERL | \set | \clr |
| 94 | xor t0, ST0_EXL | ST0_ERL | \clr |
| 95 | mtc0 t0, CP0_STATUS |
| 96 | #else |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | mfc0 t0, CP0_STATUS |
| 98 | or t0, ST0_CU0|\set|0x1f|\clr |
| 99 | xor t0, 0x1f|\clr |
| 100 | mtc0 t0, CP0_STATUS |
| 101 | .set noreorder |
| 102 | sll zero,3 # ehb |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 103 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | .set pop |
| 105 | .endm |
| 106 | |
| 107 | .macro setup_c0_status_pri |
Ralf Baechle | 875d43e | 2005-09-03 15:56:16 -0700 | [diff] [blame] | 108 | #ifdef CONFIG_64BIT |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | setup_c0_status ST0_KX 0 |
| 110 | #else |
| 111 | setup_c0_status 0 0 |
| 112 | #endif |
| 113 | .endm |
| 114 | |
| 115 | .macro setup_c0_status_sec |
Ralf Baechle | 875d43e | 2005-09-03 15:56:16 -0700 | [diff] [blame] | 116 | #ifdef CONFIG_64BIT |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | setup_c0_status ST0_KX ST0_BEV |
| 118 | #else |
| 119 | setup_c0_status 0 ST0_BEV |
| 120 | #endif |
| 121 | .endm |
| 122 | |
Marc St-Jean | 9267a30 | 2007-06-14 15:55:31 -0600 | [diff] [blame] | 123 | #ifndef CONFIG_NO_EXCEPT_FILL |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | /* |
| 125 | * Reserved space for exception handlers. |
| 126 | * Necessary for machines which link their kernels at KSEG0. |
| 127 | */ |
| 128 | .fill 0x400 |
Marc St-Jean | 9267a30 | 2007-06-14 15:55:31 -0600 | [diff] [blame] | 129 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | EXPORT(_stext) |
| 132 | |
Ralf Baechle | 396a2ae | 2007-10-16 20:05:18 +0100 | [diff] [blame] | 133 | #ifdef CONFIG_BOOT_RAW |
Ralf Baechle | b490ff4 | 2005-07-11 11:53:44 +0000 | [diff] [blame] | 134 | /* |
| 135 | * Give us a fighting chance of running if execution beings at the |
| 136 | * kernel load address. This is needed because this platform does |
| 137 | * not have a ELF loader yet. |
| 138 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | __INIT |
Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 140 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | |
Ralf Baechle | 396a2ae | 2007-10-16 20:05:18 +0100 | [diff] [blame] | 142 | __INIT_REFOK |
| 143 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | NESTED(kernel_entry, 16, sp) # kernel entry point |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 145 | |
Ralf Baechle | 7e35952 | 2005-07-14 09:42:32 +0000 | [diff] [blame] | 146 | kernel_entry_setup # cpu specific setup |
| 147 | |
| 148 | setup_c0_status_pri |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | |
Thomas Bogendoerfer | 15ad838 | 2007-09-13 20:23:48 +0200 | [diff] [blame] | 150 | /* We might not get launched at the address the kernel is linked to, |
| 151 | so we jump there. */ |
| 152 | PTR_LA t0, 0f |
| 153 | jr t0 |
| 154 | 0: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 156 | #ifdef CONFIG_MIPS_MT_SMTC |
| 157 | /* |
| 158 | * In SMTC kernel, "CLI" is thread-specific, in TCStatus. |
| 159 | * We still need to enable interrupts globally in Status, |
| 160 | * and clear EXL/ERL. |
| 161 | * |
| 162 | * TCContext is used to track interrupt levels under |
| 163 | * service in SMTC kernel. Clear for boot TC before |
| 164 | * allowing any interrupts. |
| 165 | */ |
| 166 | mtc0 zero, CP0_TCCONTEXT |
| 167 | |
| 168 | mfc0 t0, CP0_STATUS |
| 169 | ori t0, t0, 0xff1f |
| 170 | xori t0, t0, 0x001e |
| 171 | mtc0 t0, CP0_STATUS |
| 172 | #endif /* CONFIG_MIPS_MT_SMTC */ |
| 173 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 174 | PTR_LA t0, __bss_start # clear .bss |
| 175 | LONG_S zero, (t0) |
| 176 | PTR_LA t1, __bss_stop - LONGSIZE |
| 177 | 1: |
| 178 | PTR_ADDIU t0, LONGSIZE |
| 179 | LONG_S zero, (t0) |
| 180 | bne t0, t1, 1b |
| 181 | |
| 182 | LONG_S a0, fw_arg0 # firmware arguments |
| 183 | LONG_S a1, fw_arg1 |
| 184 | LONG_S a2, fw_arg2 |
| 185 | LONG_S a3, fw_arg3 |
| 186 | |
Thiemo Seufer | 1b3a6e9 | 2005-04-01 14:07:13 +0000 | [diff] [blame] | 187 | MTC0 zero, CP0_CONTEXT # clear context register |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 188 | PTR_LA $28, init_thread_union |
Ralf Baechle | 242954b | 2006-10-24 02:29:01 +0100 | [diff] [blame] | 189 | PTR_LI sp, _THREAD_SIZE - 32 |
| 190 | PTR_ADDU sp, $28 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | set_saved_sp sp, t0, t1 |
| 192 | PTR_SUBU sp, 4 * SZREG # init stack pointer |
| 193 | |
| 194 | j start_kernel |
| 195 | END(kernel_entry) |
| 196 | |
Ralf Baechle | b490ff4 | 2005-07-11 11:53:44 +0000 | [diff] [blame] | 197 | __INIT |
Ralf Baechle | b490ff4 | 2005-07-11 11:53:44 +0000 | [diff] [blame] | 198 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 199 | #ifdef CONFIG_SMP |
| 200 | /* |
| 201 | * SMP slave cpus entry point. Board specific code for bootstrap calls this |
| 202 | * function after setting up the stack and gp registers. |
| 203 | */ |
| 204 | NESTED(smp_bootstrap, 16, sp) |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 205 | #ifdef CONFIG_MIPS_MT_SMTC |
| 206 | /* |
| 207 | * Read-modify-writes of Status must be atomic, and this |
| 208 | * is one case where CLI is invoked without EXL being |
| 209 | * necessarily set. The CLI and setup_c0_status will |
| 210 | * in fact be redundant for all but the first TC of |
| 211 | * each VPE being booted. |
| 212 | */ |
| 213 | DMT 10 # dmt t2 /* t0, t1 are used by CLI and setup_c0_status() */ |
| 214 | jal mips_ihb |
| 215 | #endif /* CONFIG_MIPS_MT_SMTC */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 216 | setup_c0_status_sec |
Ralf Baechle | 7e35952 | 2005-07-14 09:42:32 +0000 | [diff] [blame] | 217 | smp_slave_setup |
Ralf Baechle | 41c594a | 2006-04-05 09:45:45 +0100 | [diff] [blame] | 218 | #ifdef CONFIG_MIPS_MT_SMTC |
| 219 | andi t2, t2, VPECONTROL_TE |
| 220 | beqz t2, 2f |
| 221 | EMT # emt |
| 222 | 2: |
| 223 | #endif /* CONFIG_MIPS_MT_SMTC */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 224 | j start_secondary |
| 225 | END(smp_bootstrap) |
| 226 | #endif /* CONFIG_SMP */ |
| 227 | |
| 228 | __FINIT |