blob: 171d094c334f9654b1feb6a0b7bfe33368360e68 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001/* SPDX-License-Identifier: GPL-2.0+ */
David Feng0ae76532013-12-14 11:47:35 +08002/*
3 * relocate - common relocation function for AArch64 U-Boot
4 *
5 * (C) Copyright 2013
6 * Albert ARIBAUD <albert.u.boot@aribaud.net>
7 * David Feng <fenghua@phytium.com.cn>
David Feng0ae76532013-12-14 11:47:35 +08008 */
9
10#include <asm-offsets.h>
11#include <config.h>
Simon Glassc70f74a2016-11-07 08:47:09 -070012#include <elf.h>
David Feng0ae76532013-12-14 11:47:35 +080013#include <linux/linkage.h>
York Sun83571bc2014-02-26 13:26:03 -080014#include <asm/macro.h>
David Feng0ae76532013-12-14 11:47:35 +080015
16/*
17 * void relocate_code (addr_moni)
18 *
19 * This function relocates the monitor code.
20 * x0 holds the destination address.
21 */
22ENTRY(relocate_code)
York Sun83571bc2014-02-26 13:26:03 -080023 stp x29, x30, [sp, #-32]! /* create a stack frame */
24 mov x29, sp
25 str x0, [sp, #16]
David Feng0ae76532013-12-14 11:47:35 +080026 /*
27 * Copy u-boot from flash to RAM
28 */
Stephen Warren49e93872017-11-02 18:11:27 -060029 adr x1, __image_copy_start /* x1 <- Run &__image_copy_start */
30 subs x9, x0, x1 /* x8 <- Run to copy offset */
David Feng0ae76532013-12-14 11:47:35 +080031 b.eq relocate_done /* skip relocation */
Stephen Warren49e93872017-11-02 18:11:27 -060032 /*
33 * Don't ldr x1, __image_copy_start here, since if the code is already
34 * running at an address other than it was linked to, that instruction
35 * will load the relocated value of __image_copy_start. To
36 * correctly apply relocations, we need to know the linked value.
37 *
38 * Linked &__image_copy_start, which we know was at
39 * CONFIG_SYS_TEXT_BASE, which is stored in _TEXT_BASE, as a non-
40 * relocated value, since it isn't a symbol reference.
41 */
42 ldr x1, _TEXT_BASE /* x1 <- Linked &__image_copy_start */
43 subs x9, x0, x1 /* x9 <- Link to copy offset */
David Feng0ae76532013-12-14 11:47:35 +080044
Stephen Warren49e93872017-11-02 18:11:27 -060045 adr x1, __image_copy_start /* x1 <- Run &__image_copy_start */
46 adr x2, __image_copy_end /* x2 <- Run &__image_copy_end */
David Feng0ae76532013-12-14 11:47:35 +080047copy_loop:
48 ldp x10, x11, [x1], #16 /* copy from source address [x1] */
49 stp x10, x11, [x0], #16 /* copy to target address [x0] */
50 cmp x1, x2 /* until source end address [x2] */
51 b.lo copy_loop
York Sun83571bc2014-02-26 13:26:03 -080052 str x0, [sp, #24]
David Feng0ae76532013-12-14 11:47:35 +080053
54 /*
55 * Fix .rela.dyn relocations
56 */
Stephen Warren49e93872017-11-02 18:11:27 -060057 adr x2, __rel_dyn_start /* x2 <- Run &__rel_dyn_start */
58 adr x3, __rel_dyn_end /* x3 <- Run &__rel_dyn_end */
David Feng0ae76532013-12-14 11:47:35 +080059fixloop:
60 ldp x0, x1, [x2], #16 /* (x0,x1) <- (SRC location, fixup) */
61 ldr x4, [x2], #8 /* x4 <- addend */
62 and x1, x1, #0xffffffff
Simon Glassc70f74a2016-11-07 08:47:09 -070063 cmp x1, #R_AARCH64_RELATIVE
David Feng0ae76532013-12-14 11:47:35 +080064 bne fixnext
65
66 /* relative fix: store addend plus offset at dest location */
67 add x0, x0, x9
68 add x4, x4, x9
69 str x4, [x0]
70fixnext:
71 cmp x2, x3
72 b.lo fixloop
73
74relocate_done:
York Sun83571bc2014-02-26 13:26:03 -080075 switch_el x1, 3f, 2f, 1f
76 bl hang
773: mrs x0, sctlr_el3
78 b 0f
792: mrs x0, sctlr_el2
80 b 0f
811: mrs x0, sctlr_el1
820: tbz w0, #2, 5f /* skip flushing cache if disabled */
Masahiro Yamada1f4f5e52017-02-04 12:30:06 +090083 tbz w0, #12, 4f /* skip invalidating i-cache if disabled */
York Sun83571bc2014-02-26 13:26:03 -080084 ic iallu /* i-cache invalidate all */
85 isb sy
864: ldp x0, x1, [sp, #16]
87 bl __asm_flush_dcache_range
zijun_hu7baf952f2017-09-23 13:30:58 +0800885: ldp x29, x30, [sp],#32
David Feng0ae76532013-12-14 11:47:35 +080089 ret
90ENDPROC(relocate_code)