129 строки
3.9 KiB
ArmAsm
129 строки
3.9 KiB
ArmAsm
/*
|
|
* arch/v850/kernel/head.S -- Lowest-level startup code
|
|
*
|
|
* Copyright (C) 2001,02,03 NEC Electronics Corporation
|
|
* Copyright (C) 2001,02,03 Miles Bader <miles@gnu.org>
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General
|
|
* Public License. See the file COPYING in the main directory of this
|
|
* archive for more details.
|
|
*
|
|
* Written by Miles Bader <miles@gnu.org>
|
|
*/
|
|
|
|
#include <asm/clinkage.h>
|
|
#include <asm/current.h>
|
|
#include <asm/entry.h>
|
|
#include <asm/thread_info.h>
|
|
#include <asm/irq.h>
|
|
|
|
|
|
/* Make a slightly more convenient alias for C_SYMBOL_NAME. */
|
|
#define CSYM C_SYMBOL_NAME
|
|
|
|
|
|
.text
|
|
|
|
// Define `mach_early_init' as a weak symbol
|
|
.global CSYM(mach_early_init)
|
|
.weak CSYM(mach_early_init)
|
|
|
|
C_ENTRY(start):
|
|
// Make sure interrupts are turned off, just in case
|
|
di
|
|
|
|
#ifdef CONFIG_RESET_GUARD
|
|
// See if we got here via an unexpected reset
|
|
ld.w RESET_GUARD, r19 // Check current value of reset guard
|
|
mov RESET_GUARD_ACTIVE, r20
|
|
cmp r19, r20
|
|
bne 1f // Guard was not active
|
|
|
|
// If we get here, the reset guard was active. Load up some
|
|
// interesting values as arguments, and jump to the handler.
|
|
st.w r0, RESET_GUARD // Allow further resets to succeed
|
|
mov lp, r6 // Arg 0: return address
|
|
ld.b KM, r7 // Arg 1: kernel mode
|
|
mov sp, r9 // Arg 3: stack pointer
|
|
ld.w KSP, r19 // maybe switch to kernel stack
|
|
cmp r7, r0 // see if already in kernel mode
|
|
cmov z, r19, sp, sp // and switch to kernel stack if not
|
|
GET_CURRENT_TASK(r8) // Arg 2: task pointer
|
|
jr CSYM(unexpected_reset)
|
|
|
|
1: st.w r20, RESET_GUARD // Turn on reset guard
|
|
#endif /* CONFIG_RESET_GUARD */
|
|
|
|
// Setup a temporary stack for doing pre-initialization function calls.
|
|
//
|
|
// We can't use the initial kernel stack, because (1) it may be
|
|
// located in memory we're not allowed to touch, and (2) since
|
|
// it's in the data segment, calling memcpy to initialize that
|
|
// area from ROM will overwrite memcpy's return address.
|
|
mov hilo(CSYM(_init_stack_end) - 4), sp
|
|
|
|
// See if there's a platform-specific early-initialization routine
|
|
// defined; it's a weak symbol, so it will have an address of zero if
|
|
// there's not.
|
|
mov hilo(CSYM(mach_early_init)), r6
|
|
cmp r6, r0
|
|
bz 3f
|
|
|
|
// There is one, so call it. If this function is written in C, it
|
|
// should be very careful -- the stack pointer is valid, but very
|
|
// little else is (e.g., bss is not zeroed yet, and initialized data
|
|
// hasn't been).
|
|
jarl 2f, lp // first figure out return address
|
|
2: add 3f - ., lp
|
|
jmp [r6] // do call
|
|
3:
|
|
|
|
#ifdef CONFIG_ROM_KERNEL
|
|
// Copy the data area from ROM to RAM
|
|
mov hilo(CSYM(_rom_copy_dst_start)), r6
|
|
mov hilo(CSYM(_rom_copy_src_start)), r7
|
|
mov hilo(CSYM(_rom_copy_dst_end)), r8
|
|
sub r6, r8
|
|
jarl CSYM(memcpy), lp
|
|
#endif
|
|
|
|
// Load the initial thread's stack, and current task pointer (in r16)
|
|
mov hilo(CSYM(init_thread_union)), r19
|
|
movea THREAD_SIZE, r19, sp
|
|
ld.w TI_TASK[r19], CURRENT_TASK
|
|
|
|
#ifdef CONFIG_TIME_BOOTUP
|
|
/* This stuff must come after mach_early_init, because interrupts may
|
|
not work until after its been called. */
|
|
jarl CSYM(highres_timer_reset), lp
|
|
jarl CSYM(highres_timer_start), lp
|
|
#endif
|
|
|
|
// Kernel stack pointer save location
|
|
st.w sp, KSP
|
|
|
|
// Assert that we're in `kernel mode'
|
|
mov 1, r19
|
|
st.w r19, KM
|
|
|
|
#ifdef CONFIG_ZERO_BSS
|
|
// Zero bss area, since we can't rely upon any loader to do so
|
|
mov hilo(CSYM(_sbss)), r6
|
|
mov r0, r7
|
|
mov hilo(CSYM(_ebss)), r8
|
|
sub r6, r8
|
|
jarl CSYM(memset), lp
|
|
#endif
|
|
|
|
// What happens if the main kernel function returns (it shouldn't)
|
|
mov hilo(CSYM(machine_halt)), lp
|
|
|
|
// Start the linux kernel. We use an indirect jump to get extra
|
|
// range, because on some platforms this initial startup code
|
|
// (and the associated platform-specific code in mach_early_init)
|
|
// are located far away from the main kernel, e.g. so that they
|
|
// can initialize RAM first and copy the kernel or something.
|
|
mov hilo(CSYM(start_kernel)), r12
|
|
jmp [r12]
|
|
C_END(start)
|