301 lines
6.9 KiB
ArmAsm
301 lines
6.9 KiB
ArmAsm
|
/*
|
||
|
|
* Copyright (C) Paul Mackerras 1997.
|
||
|
|
*
|
||
|
|
* Adapted for 64 bit LE PowerPC by Andrew Tauferner
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or
|
||
|
|
* modify it under the terms of the GNU General Public License
|
||
|
|
* as published by the Free Software Foundation; either version
|
||
|
|
* 2 of the License, or (at your option) any later version.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "ppc_asm.h"
|
||
|
|
|
||
|
|
RELA = 7
|
||
|
|
RELACOUNT = 0x6ffffff9
|
||
|
|
|
||
|
|
.text
|
||
|
|
/* A procedure descriptor used when booting this as a COFF file.
|
||
|
|
* When making COFF, this comes first in the link and we're
|
||
|
|
* linked at 0x500000.
|
||
|
|
*/
|
||
|
|
.globl _zimage_start_opd
|
||
|
|
_zimage_start_opd:
|
||
|
|
.long 0x500000, 0, 0, 0
|
||
|
|
|
||
|
|
#ifdef __powerpc64__
|
||
|
|
.balign 8
|
||
|
|
p_start: .llong _start
|
||
|
|
p_etext: .llong _etext
|
||
|
|
p_bss_start: .llong __bss_start
|
||
|
|
p_end: .llong _end
|
||
|
|
|
||
|
|
p_toc: .llong __toc_start + 0x8000 - p_base
|
||
|
|
p_dyn: .llong __dynamic_start - p_base
|
||
|
|
p_rela: .llong __rela_dyn_start - p_base
|
||
|
|
p_prom: .llong 0
|
||
|
|
.weak _platform_stack_top
|
||
|
|
p_pstack: .llong _platform_stack_top
|
||
|
|
#else
|
||
|
|
p_start: .long _start
|
||
|
|
p_etext: .long _etext
|
||
|
|
p_bss_start: .long __bss_start
|
||
|
|
p_end: .long _end
|
||
|
|
|
||
|
|
.weak _platform_stack_top
|
||
|
|
p_pstack: .long _platform_stack_top
|
||
|
|
#endif
|
||
|
|
|
||
|
|
.weak _zimage_start
|
||
|
|
.globl _zimage_start
|
||
|
|
_zimage_start:
|
||
|
|
.globl _zimage_start_lib
|
||
|
|
_zimage_start_lib:
|
||
|
|
/* Work out the offset between the address we were linked at
|
||
|
|
and the address where we're running. */
|
||
|
|
bl .+4
|
||
|
|
p_base: mflr r10 /* r10 now points to runtime addr of p_base */
|
||
|
|
#ifndef __powerpc64__
|
||
|
|
/* grab the link address of the dynamic section in r11 */
|
||
|
|
addis r11,r10,(_GLOBAL_OFFSET_TABLE_-p_base)@ha
|
||
|
|
lwz r11,(_GLOBAL_OFFSET_TABLE_-p_base)@l(r11)
|
||
|
|
cmpwi r11,0
|
||
|
|
beq 3f /* if not linked -pie */
|
||
|
|
/* get the runtime address of the dynamic section in r12 */
|
||
|
|
.weak __dynamic_start
|
||
|
|
addis r12,r10,(__dynamic_start-p_base)@ha
|
||
|
|
addi r12,r12,(__dynamic_start-p_base)@l
|
||
|
|
subf r11,r11,r12 /* runtime - linktime offset */
|
||
|
|
|
||
|
|
/* The dynamic section contains a series of tagged entries.
|
||
|
|
* We need the RELA and RELACOUNT entries. */
|
||
|
|
li r9,0
|
||
|
|
li r0,0
|
||
|
|
9: lwz r8,0(r12) /* get tag */
|
||
|
|
cmpwi r8,0
|
||
|
|
beq 10f /* end of list */
|
||
|
|
cmpwi r8,RELA
|
||
|
|
bne 11f
|
||
|
|
lwz r9,4(r12) /* get RELA pointer in r9 */
|
||
|
|
b 12f
|
||
|
|
11: addis r8,r8,(-RELACOUNT)@ha
|
||
|
|
cmpwi r8,RELACOUNT@l
|
||
|
|
bne 12f
|
||
|
|
lwz r0,4(r12) /* get RELACOUNT value in r0 */
|
||
|
|
12: addi r12,r12,8
|
||
|
|
b 9b
|
||
|
|
|
||
|
|
/* The relocation section contains a list of relocations.
|
||
|
|
* We now do the R_PPC_RELATIVE ones, which point to words
|
||
|
|
* which need to be initialized with addend + offset.
|
||
|
|
* The R_PPC_RELATIVE ones come first and there are RELACOUNT
|
||
|
|
* of them. */
|
||
|
|
10: /* skip relocation if we don't have both */
|
||
|
|
cmpwi r0,0
|
||
|
|
beq 3f
|
||
|
|
cmpwi r9,0
|
||
|
|
beq 3f
|
||
|
|
|
||
|
|
add r9,r9,r11 /* Relocate RELA pointer */
|
||
|
|
mtctr r0
|
||
|
|
2: lbz r0,4+3(r9) /* ELF32_R_INFO(reloc->r_info) */
|
||
|
|
cmpwi r0,22 /* R_PPC_RELATIVE */
|
||
|
|
bne 3f
|
||
|
|
lwz r12,0(r9) /* reloc->r_offset */
|
||
|
|
lwz r0,8(r9) /* reloc->r_addend */
|
||
|
|
add r0,r0,r11
|
||
|
|
stwx r0,r11,r12
|
||
|
|
addi r9,r9,12
|
||
|
|
bdnz 2b
|
||
|
|
|
||
|
|
/* Do a cache flush for our text, in case the loader didn't */
|
||
|
|
3: lwz r9,p_start-p_base(r10) /* note: these are relocated now */
|
||
|
|
lwz r8,p_etext-p_base(r10)
|
||
|
|
4: dcbf r0,r9
|
||
|
|
icbi r0,r9
|
||
|
|
addi r9,r9,0x20
|
||
|
|
cmplw cr0,r9,r8
|
||
|
|
blt 4b
|
||
|
|
sync
|
||
|
|
isync
|
||
|
|
|
||
|
|
/* Clear the BSS */
|
||
|
|
lwz r9,p_bss_start-p_base(r10)
|
||
|
|
lwz r8,p_end-p_base(r10)
|
||
|
|
li r0,0
|
||
|
|
5: stw r0,0(r9)
|
||
|
|
addi r9,r9,4
|
||
|
|
cmplw cr0,r9,r8
|
||
|
|
blt 5b
|
||
|
|
|
||
|
|
/* Possibly set up a custom stack */
|
||
|
|
lwz r8,p_pstack-p_base(r10)
|
||
|
|
cmpwi r8,0
|
||
|
|
beq 6f
|
||
|
|
lwz r1,0(r8)
|
||
|
|
li r0,0
|
||
|
|
stwu r0,-16(r1) /* establish a stack frame */
|
||
|
|
6:
|
||
|
|
#else /* __powerpc64__ */
|
||
|
|
/* Save the prom pointer at p_prom. */
|
||
|
|
std r5,(p_prom-p_base)(r10)
|
||
|
|
|
||
|
|
/* Set r2 to the TOC. */
|
||
|
|
ld r2,(p_toc-p_base)(r10)
|
||
|
|
add r2,r2,r10
|
||
|
|
|
||
|
|
/* Grab the link address of the dynamic section in r11. */
|
||
|
|
ld r11,-32768(r2)
|
||
|
|
cmpwi r11,0
|
||
|
|
beq 3f /* if not linked -pie then no dynamic section */
|
||
|
|
|
||
|
|
ld r11,(p_dyn-p_base)(r10)
|
||
|
|
add r11,r11,r10
|
||
|
|
ld r9,(p_rela-p_base)(r10)
|
||
|
|
add r9,r9,r10
|
||
|
|
|
||
|
|
li r7,0
|
||
|
|
li r8,0
|
||
|
|
9: ld r6,0(r11) /* get tag */
|
||
|
|
cmpdi r6,0
|
||
|
|
beq 12f /* end of list */
|
||
|
|
cmpdi r6,RELA
|
||
|
|
bne 10f
|
||
|
|
ld r7,8(r11) /* get RELA pointer in r7 */
|
||
|
|
b 11f
|
||
|
|
10: addis r6,r6,(-RELACOUNT)@ha
|
||
|
|
cmpdi r6,RELACOUNT@l
|
||
|
|
bne 11f
|
||
|
|
ld r8,8(r11) /* get RELACOUNT value in r8 */
|
||
|
|
11: addi r11,r11,16
|
||
|
|
b 9b
|
||
|
|
12:
|
||
|
|
cmpdi r7,0 /* check we have both RELA and RELACOUNT */
|
||
|
|
cmpdi cr1,r8,0
|
||
|
|
beq 3f
|
||
|
|
beq cr1,3f
|
||
|
|
|
||
|
|
/* Calcuate the runtime offset. */
|
||
|
|
subf r7,r7,r9
|
||
|
|
|
||
|
|
/* Run through the list of relocations and process the
|
||
|
|
* R_PPC64_RELATIVE ones. */
|
||
|
|
mtctr r8
|
||
|
|
13: ld r0,8(r9) /* ELF64_R_TYPE(reloc->r_info) */
|
||
|
|
cmpdi r0,22 /* R_PPC64_RELATIVE */
|
||
|
|
bne 3f
|
||
|
|
ld r6,0(r9) /* reloc->r_offset */
|
||
|
|
ld r0,16(r9) /* reloc->r_addend */
|
||
|
|
add r0,r0,r7
|
||
|
|
stdx r0,r7,r6
|
||
|
|
addi r9,r9,24
|
||
|
|
bdnz 13b
|
||
|
|
|
||
|
|
/* Do a cache flush for our text, in case the loader didn't */
|
||
|
|
3: ld r9,p_start-p_base(r10) /* note: these are relocated now */
|
||
|
|
ld r8,p_etext-p_base(r10)
|
||
|
|
4: dcbf r0,r9
|
||
|
|
icbi r0,r9
|
||
|
|
addi r9,r9,0x20
|
||
|
|
cmpld cr0,r9,r8
|
||
|
|
blt 4b
|
||
|
|
sync
|
||
|
|
isync
|
||
|
|
|
||
|
|
/* Clear the BSS */
|
||
|
|
ld r9,p_bss_start-p_base(r10)
|
||
|
|
ld r8,p_end-p_base(r10)
|
||
|
|
li r0,0
|
||
|
|
5: std r0,0(r9)
|
||
|
|
addi r9,r9,8
|
||
|
|
cmpld cr0,r9,r8
|
||
|
|
blt 5b
|
||
|
|
|
||
|
|
/* Possibly set up a custom stack */
|
||
|
|
ld r8,p_pstack-p_base(r10)
|
||
|
|
cmpdi r8,0
|
||
|
|
beq 6f
|
||
|
|
ld r1,0(r8)
|
||
|
|
li r0,0
|
||
|
|
stdu r0,-16(r1) /* establish a stack frame */
|
||
|
|
6:
|
||
|
|
#endif /* __powerpc64__ */
|
||
|
|
/* Call platform_init() */
|
||
|
|
bl platform_init
|
||
|
|
|
||
|
|
/* Call start */
|
||
|
|
b start
|
||
|
|
|
||
|
|
#ifdef __powerpc64__
|
||
|
|
|
||
|
|
#define PROM_FRAME_SIZE 512
|
||
|
|
#define SAVE_GPR(n, base) std n,8*(n)(base)
|
||
|
|
#define REST_GPR(n, base) ld n,8*(n)(base)
|
||
|
|
#define SAVE_2GPRS(n, base) SAVE_GPR(n, base); SAVE_GPR(n+1, base)
|
||
|
|
#define SAVE_4GPRS(n, base) SAVE_2GPRS(n, base); SAVE_2GPRS(n+2, base)
|
||
|
|
#define SAVE_8GPRS(n, base) SAVE_4GPRS(n, base); SAVE_4GPRS(n+4, base)
|
||
|
|
#define SAVE_10GPRS(n, base) SAVE_8GPRS(n, base); SAVE_2GPRS(n+8, base)
|
||
|
|
#define REST_2GPRS(n, base) REST_GPR(n, base); REST_GPR(n+1, base)
|
||
|
|
#define REST_4GPRS(n, base) REST_2GPRS(n, base); REST_2GPRS(n+2, base)
|
||
|
|
#define REST_8GPRS(n, base) REST_4GPRS(n, base); REST_4GPRS(n+4, base)
|
||
|
|
#define REST_10GPRS(n, base) REST_8GPRS(n, base); REST_2GPRS(n+8, base)
|
||
|
|
|
||
|
|
/* prom handles the jump into and return from firmware. The prom args pointer
|
||
|
|
is loaded in r3. */
|
||
|
|
.globl prom
|
||
|
|
prom:
|
||
|
|
mflr r0
|
||
|
|
std r0,16(r1)
|
||
|
|
stdu r1,-PROM_FRAME_SIZE(r1) /* Save SP and create stack space */
|
||
|
|
|
||
|
|
SAVE_GPR(2, r1)
|
||
|
|
SAVE_GPR(13, r1)
|
||
|
|
SAVE_8GPRS(14, r1)
|
||
|
|
SAVE_10GPRS(22, r1)
|
||
|
|
mfcr r10
|
||
|
|
std r10,8*32(r1)
|
||
|
|
mfmsr r10
|
||
|
|
std r10,8*33(r1)
|
||
|
|
|
||
|
|
/* remove MSR_LE from msr but keep MSR_SF */
|
||
|
|
mfmsr r10
|
||
|
|
rldicr r10,r10,0,62
|
||
|
|
mtsrr1 r10
|
||
|
|
|
||
|
|
/* Load FW address, set LR to label 1, and jump to FW */
|
||
|
|
bl 0f
|
||
|
|
0: mflr r10
|
||
|
|
addi r11,r10,(1f-0b)
|
||
|
|
mtlr r11
|
||
|
|
|
||
|
|
ld r10,(p_prom-0b)(r10)
|
||
|
|
mtsrr0 r10
|
||
|
|
|
||
|
|
rfid
|
||
|
|
|
||
|
|
1: /* Return from OF */
|
||
|
|
FIXUP_ENDIAN
|
||
|
|
|
||
|
|
/* Restore registers and return. */
|
||
|
|
rldicl r1,r1,0,32
|
||
|
|
|
||
|
|
/* Restore the MSR (back to 64 bits) */
|
||
|
|
ld r10,8*(33)(r1)
|
||
|
|
mtmsr r10
|
||
|
|
isync
|
||
|
|
|
||
|
|
/* Restore other registers */
|
||
|
|
REST_GPR(2, r1)
|
||
|
|
REST_GPR(13, r1)
|
||
|
|
REST_8GPRS(14, r1)
|
||
|
|
REST_10GPRS(22, r1)
|
||
|
|
ld r10,8*32(r1)
|
||
|
|
mtcr r10
|
||
|
|
|
||
|
|
addi r1,r1,PROM_FRAME_SIZE
|
||
|
|
ld r0,16(r1)
|
||
|
|
mtlr r0
|
||
|
|
blr
|
||
|
|
#endif
|