locore.S revision 202175
1/* $OpenBSD: locore.S,v 1.18 1998/09/15 10:58:53 pefo Exp $ */ 2/*- 3 * Copyright (c) 1992, 1993 4 * The Regents of the University of California. All rights reserved. 5 * 6 * This code is derived from software contributed to Berkeley by 7 * Digital Equipment Corporation and Ralph Campbell. 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 * 4. Neither the name of the University nor the names of its contributors 18 * may be used to endorse or promote products derived from this software 19 * without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * Copyright (C) 1989 Digital Equipment Corporation. 34 * Permission to use, copy, modify, and distribute this software and 35 * its documentation for any purpose and without fee is hereby granted, 36 * provided that the above copyright notice appears in all copies. 37 * Digital Equipment Corporation makes no representations about the 38 * suitability of this software for any purpose. It is provided "as is" 39 * without express or implied warranty. 40 * 41 * from: Header: /sprite/src/kernel/mach/ds3100.md/RCS/loMem.s, 42 * v 1.1 89/07/11 17:55:04 nelson Exp SPRITE (DECWRL) 43 * from: Header: /sprite/src/kernel/mach/ds3100.md/RCS/machAsm.s, 44 * v 9.2 90/01/29 18:00:39 shirriff Exp SPRITE (DECWRL) 45 * from: Header: /sprite/src/kernel/vm/ds3100.md/vmPmaxAsm.s, 46 * v 1.1 89/07/10 14:27:41 nelson Exp SPRITE (DECWRL) 47 * 48 * from: @(#)locore.s 8.5 (Berkeley) 1/4/94 49 * JNPR: locore.S,v 1.6.2.1 2007/08/29 12:24:49 girish 50 * $FreeBSD: head/sys/mips/mips/locore.S 202175 2010-01-12 21:36:08Z imp $ 51 */ 52 53/* 54 * FREEBSD_DEVELOPERS_FIXME 55 * The start routine below was written for a multi-core CPU 56 * with each core being hyperthreaded. This serves as an example 57 * for a complex CPU architecture. For a different CPU complex 58 * please make necessary changes to read CPU-ID etc. 59 * A clean solution would be to have a different locore file for 60 * each CPU type. 61 */ 62 63/* 64 * Contains code that is the first executed at boot time plus 65 * assembly language support routines. 66 */ 67 68#include <machine/asm.h> 69#include <machine/cpu.h> 70#include <machine/cpuregs.h> 71#include <machine/regnum.h> 72 73#include "assym.s" 74 75 .data 76#ifdef YAMON 77GLOBAL(fenvp) 78 .space 4 # Assumes mips32? Is that OK? 79#endif 80GLOBAL(stackspace) 81 .space NBPG /* Smaller than it should be since it's temp. */ 82 .align 8 83GLOBAL(topstack) 84 85 86 .set noreorder 87 88 .text 89 90GLOBAL(btext) 91ASM_ENTRY(_start) 92VECTOR(_locore, unknown) 93 /* UNSAFE TO USE a0..a3, since some bootloaders pass that to us */ 94 mtc0 zero, COP_0_CAUSE_REG # Clear soft interrupts 95 96#if defined(TARGET_OCTEON) 97 /* 98 * t1: Bits to set explicitly: 99 * Enable FPU 100 */ 101 102 /* Set these bits */ 103 li t1, (MIPS_SR_COP_2_BIT | MIPS_SR_COP_0_BIT | MIPS_SR_PX | MIPS_SR_KX | MIPS_SR_UX | MIPS_SR_SX | MIPS_SR_BEV) 104 105 /* Reset these bits */ 106 li t0, ~(MIPS_SR_DE | MIPS_SR_SOFT_RESET | MIPS_SR_ERL | MIPS_SR_EXL | MIPS_SR_INT_IE) 107#else 108 /* 109 * t0: Bits to preserve if set: 110 * Soft reset 111 * Boot exception vectors (firmware-provided) 112 */ 113 li t0, (MIPS_SR_BEV | MIPS_SR_SOFT_RESET) 114 /* 115 * t1: Bits to set explicitly: 116 * Enable FPU 117 */ 118 li t1, MIPS_SR_COP_1_BIT 119#endif 120 /* 121 * Read coprocessor 0 status register, clear bits not 122 * preserved (namely, clearing interrupt bits), and set 123 * bits we want to explicitly set. 124 */ 125 mfc0 t2, COP_0_STATUS_REG 126 and t2, t0 127 or t2, t1 128 mtc0 t2, COP_0_STATUS_REG 129 COP0_SYNC 130 /* Make sure KSEG0 is cached */ 131#ifdef CPU_SB1 132 li t0, CFG_K0_COHERENT 133#else 134 li t0, CFG_K0_CACHED 135#endif 136 mtc0 t0, MIPS_COP_0_CONFIG 137 COP0_SYNC 138 139 /* Read and store the PrID FPU ID for CPU identification, if any. */ 140 mfc0 t2, COP_0_STATUS_REG 141 mfc0 t0, MIPS_COP_0_PRID 142#ifdef CPU_HAVEFPU 143 and t2, MIPS_SR_COP_1_BIT 144 beqz t2, 1f 145 move t1, zero 146 cfc1 t1, MIPS_FPU_ID 1471: 148#else 149 /* 150 * This platform has no FPU, and attempting to detect one 151 * using the official method causes an exception. 152 */ 153 move t1, zero 154#endif 155 sw t0, _C_LABEL(cpu_id) 156 sw t1, _C_LABEL(fpu_id) 157 158/* 159 * Initialize stack and call machine startup. 160 */ 161 PTR_LA sp, _C_LABEL(topstack) - START_FRAME 162 PTR_LA gp, _C_LABEL(_gp) 163 sw zero, START_FRAME - 4(sp) # Zero out old ra for debugger 164 165 /*xxximp 166 * now that we pass a0...a3 to the platform_init routine, do we need 167 * to stash this stuff here? 168 */ 169#ifdef YAMON 170 /* Save YAMON boot environment pointer */ 171 sw a2, _C_LABEL(fenvp) 172#endif 173 174 /* 175 * The following needs to be done differently for each platform and 176 * there needs to be a good way to plug this in. 177 */ 178#if defined(SMP) && defined(CPU_XLR) 179/* 180 * Block all the slave CPUs 181 */ 182 /* XXX a0, a1, a2 shouldn't be used here */ 183 /* 184 * Read the cpu id from the cp0 config register 185 * cpuid[9:4], thrid[3: 0] 186 */ 187 mfc0 a0, COP_0_CONFIG, 7 188 srl a1, a0, 4 189 andi a1, a1, 0x3f 190 andi a0, a0, 0xf 191 192 /* calculate linear cpuid */ 193 sll t0, a1, 2 194 addu a2, t0, a0 195/* Initially, disable all hardware threads on each core except thread0 */ 196 li t1, VCPU_ID_0 197 li t2, XLR_THREAD_ENABLE_IND 198 mtcr t1, t2 199#endif 200 201 202#if defined(TARGET_OCTEON) /* Maybe this is mips32/64 generic? */ 203 .set push 204 .set mips32r2 205 rdhwr t0, $0 206 .set pop 207#else 208 move t0, zero 209#endif 210 211 /* Stage the secondary cpu start until later */ 212 bne t0, zero, start_secondary 213 nop 214 215#ifdef SMP 216 PTR_LA t0, _C_LABEL(__pcpu) 217 SET_CPU_PCPU(t0) 218 /* If not master cpu, jump... */ 219/*XXX this assumes the above #if 0'd code runs */ 220 bne a2, zero, start_secondary 221 nop 222#endif 223 224 /* Call the platform-specific startup code. */ 225 jal _C_LABEL(platform_start) 226 sw zero, START_FRAME - 8(sp) # Zero out old fp for debugger 227 228 PTR_LA sp, _C_LABEL(thread0) 229 lw a0, TD_PCB(sp) 230 li t0, ~7 231 and a0, a0, t0 232 subu sp, a0, START_FRAME 233 234 jal _C_LABEL(mi_startup) # mi_startup(frame) 235 sw zero, START_FRAME - 8(sp) # Zero out old fp for debugger 236 237 PANIC("Startup failed!") 238 239#ifdef SMP 240start_secondary: 241 move a0, a1 2422: 243 addiu t0, PCPU_SIZE 244 subu a1, 1 245 bne a1, zero, 2b 246 nop 247 SET_CPU_PCPU(t0) 248smp_wait: 249 lw sp, PC_BOOT_STACK(t0) 250 beqz sp, smp_wait 251 nop 252 jal _C_LABEL(smp_init_secondary) 253 nop 254#else 255start_secondary: 256 b start_secondary 257 nop 258#endif 259 260VECTOR_END(_locore) 261