1/*- 2 * Copyright (c) 2008 Semihalf, Rafal Czubak 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD$ 27 */ 28 29#include <machine/asm.h> 30#include <machine/armreg.h> 31 32 .text 33 .extern _C_LABEL(self_reloc), _C_LABEL(main) 34 .weak _DYNAMIC 35 36/* 37 * Entry point to the loader that U-Boot passes control to. 38 */ 39 .globl _start 40_start: 41 42#ifdef _ARM_ARCH_6 43 mrc p15, 0, ip, c1, c0, 0 44 orr ip, ip, #(CPU_CONTROL_UNAL_ENABLE) 45 orr ip, ip, #(CPU_CONTROL_AFLT_ENABLE) 46 mcr p15, 0, ip, c1, c0, 0 47#endif 48 49 /* Save the arguments and return register before calling self_reloc */ 50 push {r0, r1, r9, lr} 51 52 /* 53 * Do self-relocation when the weak external symbol _DYNAMIC is non-NULL. 54 * When linked as a dynamic relocatable file, the linker automatically 55 * defines _DYNAMIC with a value that is the offset of the dynamic 56 * relocation info section. 57 * Note that we're still on u-boot's stack here, but the self_reloc 58 * code uses only a couple dozen bytes of stack space. 59 */ 60 adr ip, .here_off /* .here_off is a symbol whose value */ 61 ldr r0, [ip] /* is its own offset in the text seg. */ 62 sub r0, ip, r0 /* Get its pc-relative address and */ 63 ldr r1, .dynamic_off /* subtract its value and we get */ 64 teq r1, #0 /* r0 = physaddr we were loaded at. */ 65 addne r1, r1, r0 /* r1 = dynamic section physaddr. */ 66 blne _C_LABEL(self_reloc) /* Do reloc if _DYNAMIC is non-NULL. */ 67 68 /* Restore saved arguments */ 69 pop {r0, r1, r9, lr} 70 71 /* Hint where to look for the API signature */ 72 ldr ip, =uboot_address 73 str sp, [ip] 74 75 /* Save U-Boot's r8 and r9 for syscall trampoline */ 76 ldr ip, =saved_regs 77 str r8, [ip, #0] /* old gd pointer (use to hold lr) */ 78 str r9, [ip, #4] /* new gd pointer */ 79 80 /* 81 * Start loader. Save return address first (r8 is available from 82 * trampoline save). 83 */ 84 mov r8, lr 85 bl main 86 mov lr, r8 87 88 /* Restore U-Boot environment */ 89 ldr ip, =saved_regs 90 ldr r8, [ip, #0] 91 ldr r9, [ip, #4] 92 mov pc, lr 93 94 /* 95 * Data for self-relocation, in the text segment for pc-rel access. 96 */ 97.here_off: 98 .word . 99.dynamic_off: 100 .word _DYNAMIC 101 102/* 103 * syscall() 104 */ 105ENTRY(syscall) 106 /* Save caller's lr, r8 and r9 */ 107 ldr ip, =saved_regs 108 str r8, [ip, #8] 109 str r9, [ip, #12] 110 str lr, [ip, #16] 111 /* Restore U-Boot's r8 and r9 */ 112 ldr r8, [ip, #0] 113 ldr r9, [ip, #4] 114 /* Call into U-Boot */ 115 ldr lr, =return_from_syscall 116 ldr ip, =syscall_ptr 117 ldr pc, [ip] 118return_from_syscall: 119 /* Restore loader's r8, r9 and lr */ 120 ldr ip, =saved_regs 121 ldr lr, [ip, #16] 122 ldr r9, [ip, #12] 123 ldr r8, [ip, #8] 124 /* Return to caller */ 125 mov pc, lr 126 127/* 128 * Data section 129 */ 130 .data 131 .align 4 132 .globl syscall_ptr 133syscall_ptr: 134 .long 0 135 136 .globl uboot_address 137uboot_address: 138 .long 0 139 140saved_regs: 141 .long 0 /* U-Boot's r8 */ 142 .long 0 /* U-Boot's r9 */ 143 .long 0 /* Loader's r8 */ 144 .long 0 /* Loader's r9 */ 145 .long 0 /* Loader's lr */ 146