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> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | #include <asm/mipsregs.h> |
| 25 | #include <asm/stackframe.h> |
Ralf Baechle | 7e35952 | 2005-07-14 09:42:32 +0000 | [diff] [blame] | 26 | |
| 27 | #include <kernel-entry-init.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 28 | |
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 | * For the moment disable interrupts, mark the kernel mode and |
| 31 | * set ST0_KX so that the CPU does not spit fire when using |
| 32 | * 64-bit addresses. A full initialization of the CPU's status |
| 33 | * register is done later in per_cpu_trap_init(). |
| 34 | */ |
| 35 | .macro setup_c0_status set clr |
| 36 | .set push |
| 37 | mfc0 t0, CP0_STATUS |
| 38 | or t0, ST0_CU0|\set|0x1f|\clr |
| 39 | xor t0, 0x1f|\clr |
| 40 | mtc0 t0, CP0_STATUS |
| 41 | .set noreorder |
| 42 | sll zero,3 # ehb |
| 43 | .set pop |
| 44 | .endm |
| 45 | |
| 46 | .macro setup_c0_status_pri |
Ralf Baechle | 875d43e | 2005-09-03 15:56:16 -0700 | [diff] [blame] | 47 | #ifdef CONFIG_64BIT |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | setup_c0_status ST0_KX 0 |
| 49 | #else |
| 50 | setup_c0_status 0 0 |
| 51 | #endif |
| 52 | .endm |
| 53 | |
| 54 | .macro setup_c0_status_sec |
Ralf Baechle | 875d43e | 2005-09-03 15:56:16 -0700 | [diff] [blame] | 55 | #ifdef CONFIG_64BIT |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 56 | setup_c0_status ST0_KX ST0_BEV |
| 57 | #else |
| 58 | setup_c0_status 0 ST0_BEV |
| 59 | #endif |
| 60 | .endm |
| 61 | |
Marc St-Jean | 9267a30 | 2007-06-14 15:55:31 -0600 | [diff] [blame] | 62 | #ifndef CONFIG_NO_EXCEPT_FILL |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | /* |
| 64 | * Reserved space for exception handlers. |
| 65 | * Necessary for machines which link their kernels at KSEG0. |
| 66 | */ |
| 67 | .fill 0x400 |
Marc St-Jean | 9267a30 | 2007-06-14 15:55:31 -0600 | [diff] [blame] | 68 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | EXPORT(_stext) |
| 71 | |
Ralf Baechle | 396a2ae | 2007-10-16 20:05:18 +0100 | [diff] [blame] | 72 | #ifdef CONFIG_BOOT_RAW |
Ralf Baechle | b490ff4 | 2005-07-11 11:53:44 +0000 | [diff] [blame] | 73 | /* |
| 74 | * Give us a fighting chance of running if execution beings at the |
Ralf Baechle | 7034228 | 2013-01-22 12:59:30 +0100 | [diff] [blame] | 75 | * kernel load address. This is needed because this platform does |
Ralf Baechle | b490ff4 | 2005-07-11 11:53:44 +0000 | [diff] [blame] | 76 | * not have a ELF loader yet. |
| 77 | */ |
Ralf Baechle | ba820c5 | 2008-01-07 15:09:50 +0000 | [diff] [blame] | 78 | FEXPORT(__kernel_entry) |
| 79 | j kernel_entry |
Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 80 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | |
Ralf Baechle | a055917 | 2008-01-30 12:14:59 +0000 | [diff] [blame] | 82 | __REF |
Ralf Baechle | 396a2ae | 2007-10-16 20:05:18 +0100 | [diff] [blame] | 83 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | NESTED(kernel_entry, 16, sp) # kernel entry point |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | |
Ralf Baechle | 7e35952 | 2005-07-14 09:42:32 +0000 | [diff] [blame] | 86 | kernel_entry_setup # cpu specific setup |
| 87 | |
| 88 | setup_c0_status_pri |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | |
Thomas Bogendoerfer | 15ad838 | 2007-09-13 20:23:48 +0200 | [diff] [blame] | 90 | /* We might not get launched at the address the kernel is linked to, |
| 91 | so we jump there. */ |
| 92 | PTR_LA t0, 0f |
| 93 | jr t0 |
| 94 | 0: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 95 | |
Jonas Gorski | 15f37e1 | 2016-06-20 11:27:37 +0200 | [diff] [blame] | 96 | #ifdef CONFIG_USE_OF |
Jonas Gorski | 1da8f17 | 2015-04-12 12:24:58 +0200 | [diff] [blame] | 97 | #ifdef CONFIG_MIPS_RAW_APPENDED_DTB |
Jonas Gorski | 15f37e1 | 2016-06-20 11:27:37 +0200 | [diff] [blame] | 98 | PTR_LA t2, __appended_dtb |
Jonas Gorski | 1da8f17 | 2015-04-12 12:24:58 +0200 | [diff] [blame] | 99 | |
| 100 | #ifdef CONFIG_CPU_BIG_ENDIAN |
| 101 | li t1, 0xd00dfeed |
| 102 | #else |
| 103 | li t1, 0xedfe0dd0 |
| 104 | #endif |
Jonas Gorski | 15f37e1 | 2016-06-20 11:27:37 +0200 | [diff] [blame] | 105 | lw t0, (t2) |
| 106 | beq t0, t1, dtb_found |
| 107 | #endif |
| 108 | li t1, -2 |
Jonas Gorski | 15f37e1 | 2016-06-20 11:27:37 +0200 | [diff] [blame] | 109 | move t2, a1 |
Karl Beldan | 3d4ac49 | 2017-06-27 19:22:16 +0000 | [diff] [blame] | 110 | beq a0, t1, dtb_found |
Jonas Gorski | 1da8f17 | 2015-04-12 12:24:58 +0200 | [diff] [blame] | 111 | |
Jonas Gorski | 15f37e1 | 2016-06-20 11:27:37 +0200 | [diff] [blame] | 112 | li t2, 0 |
| 113 | dtb_found: |
Jonas Gorski | 1da8f17 | 2015-04-12 12:24:58 +0200 | [diff] [blame] | 114 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | PTR_LA t0, __bss_start # clear .bss |
| 116 | LONG_S zero, (t0) |
| 117 | PTR_LA t1, __bss_stop - LONGSIZE |
| 118 | 1: |
| 119 | PTR_ADDIU t0, LONGSIZE |
| 120 | LONG_S zero, (t0) |
| 121 | bne t0, t1, 1b |
| 122 | |
| 123 | LONG_S a0, fw_arg0 # firmware arguments |
| 124 | LONG_S a1, fw_arg1 |
| 125 | LONG_S a2, fw_arg2 |
| 126 | LONG_S a3, fw_arg3 |
| 127 | |
Jonas Gorski | 15f37e1 | 2016-06-20 11:27:37 +0200 | [diff] [blame] | 128 | #ifdef CONFIG_USE_OF |
| 129 | LONG_S t2, fw_passed_dtb |
| 130 | #endif |
| 131 | |
Thiemo Seufer | 1b3a6e9 | 2005-04-01 14:07:13 +0000 | [diff] [blame] | 132 | MTC0 zero, CP0_CONTEXT # clear context register |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 | PTR_LA $28, init_thread_union |
David Daney | 484889f | 2009-07-08 10:07:50 -0700 | [diff] [blame] | 134 | /* Set the SP after an empty pt_regs. */ |
| 135 | PTR_LI sp, _THREAD_SIZE - 32 - PT_SIZE |
Ralf Baechle | 242954b | 2006-10-24 02:29:01 +0100 | [diff] [blame] | 136 | PTR_ADDU sp, $28 |
Ralf Baechle | c2ea1d5 | 2009-10-13 23:23:28 +0200 | [diff] [blame] | 137 | back_to_back_c0_hazard |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | set_saved_sp sp, t0, t1 |
| 139 | PTR_SUBU sp, 4 * SZREG # init stack pointer |
| 140 | |
Matt Redfearn | af09ab5 | 2016-03-31 10:05:37 +0100 | [diff] [blame] | 141 | #ifdef CONFIG_RELOCATABLE |
| 142 | /* Copy kernel and apply the relocations */ |
| 143 | jal relocate_kernel |
| 144 | |
| 145 | /* Repoint the sp into the new kernel image */ |
| 146 | PTR_LI sp, _THREAD_SIZE - 32 - PT_SIZE |
| 147 | PTR_ADDU sp, $28 |
| 148 | set_saved_sp sp, t0, t1 |
| 149 | PTR_SUBU sp, 4 * SZREG # init stack pointer |
| 150 | |
| 151 | /* |
| 152 | * relocate_kernel returns the entry point either |
| 153 | * in the relocated kernel or the original if for |
| 154 | * some reason relocation failed - jump there now |
| 155 | * with instruction hazard barrier because of the |
| 156 | * newly sync'd icache. |
| 157 | */ |
| 158 | jr.hb v0 |
| 159 | #else |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | j start_kernel |
Matt Redfearn | af09ab5 | 2016-03-31 10:05:37 +0100 | [diff] [blame] | 161 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 162 | END(kernel_entry) |
| 163 | |
| 164 | #ifdef CONFIG_SMP |
| 165 | /* |
Ralf Baechle | 7034228 | 2013-01-22 12:59:30 +0100 | [diff] [blame] | 166 | * SMP slave cpus entry point. Board specific code for bootstrap calls this |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 167 | * function after setting up the stack and gp registers. |
| 168 | */ |
| 169 | NESTED(smp_bootstrap, 16, sp) |
Ralf Baechle | 7e35952 | 2005-07-14 09:42:32 +0000 | [diff] [blame] | 170 | smp_slave_setup |
Markos Chandras | d0ba354 | 2014-01-21 09:52:23 +0000 | [diff] [blame] | 171 | setup_c0_status_sec |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 | j start_secondary |
| 173 | END(smp_bootstrap) |
| 174 | #endif /* CONFIG_SMP */ |