blob: 72e91f2704b1757ed35adbf366204a52a04e6d09 [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/*
Simon Glass94133872019-12-28 10:44:45 -070017 * void relocate_code(addr_moni)
David Feng0ae76532013-12-14 11:47:35 +080018 *
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 */
Ibai Erkiaga98ffbb72019-03-15 12:18:41 +000029 adrp x1, __image_copy_start /* x1 <- address bits [31:12] */
30 add x1, x1, :lo12:__image_copy_start/* x1 <- address bits [11:00] */
31 subs x9, x0, x1 /* x9 <- Run to copy offset */
32 b.eq relocate_done /* skip relocation */
Stephen Warren49e93872017-11-02 18:11:27 -060033 /*
34 * Don't ldr x1, __image_copy_start here, since if the code is already
35 * running at an address other than it was linked to, that instruction
36 * will load the relocated value of __image_copy_start. To
37 * correctly apply relocations, we need to know the linked value.
38 *
39 * Linked &__image_copy_start, which we know was at
40 * CONFIG_SYS_TEXT_BASE, which is stored in _TEXT_BASE, as a non-
41 * relocated value, since it isn't a symbol reference.
42 */
43 ldr x1, _TEXT_BASE /* x1 <- Linked &__image_copy_start */
44 subs x9, x0, x1 /* x9 <- Link to copy offset */
David Feng0ae76532013-12-14 11:47:35 +080045
Ibai Erkiaga98ffbb72019-03-15 12:18:41 +000046 adrp x1, __image_copy_start /* x1 <- address bits [31:12] */
47 add x1, x1, :lo12:__image_copy_start/* x1 <- address bits [11:00] */
48 adrp x2, __image_copy_end /* x2 <- address bits [31:12] */
49 add x2, x2, :lo12:__image_copy_end /* x2 <- address bits [11:00] */
David Feng0ae76532013-12-14 11:47:35 +080050copy_loop:
51 ldp x10, x11, [x1], #16 /* copy from source address [x1] */
52 stp x10, x11, [x0], #16 /* copy to target address [x0] */
53 cmp x1, x2 /* until source end address [x2] */
54 b.lo copy_loop
York Sun83571bc2014-02-26 13:26:03 -080055 str x0, [sp, #24]
David Feng0ae76532013-12-14 11:47:35 +080056
57 /*
58 * Fix .rela.dyn relocations
59 */
Ibai Erkiaga98ffbb72019-03-15 12:18:41 +000060 adrp x2, __rel_dyn_start /* x2 <- address bits [31:12] */
61 add x2, x2, :lo12:__rel_dyn_start /* x2 <- address bits [11:00] */
62 adrp x3, __rel_dyn_end /* x3 <- address bits [31:12] */
63 add x3, x3, :lo12:__rel_dyn_end /* x3 <- address bits [11:00] */
David Feng0ae76532013-12-14 11:47:35 +080064fixloop:
65 ldp x0, x1, [x2], #16 /* (x0,x1) <- (SRC location, fixup) */
66 ldr x4, [x2], #8 /* x4 <- addend */
67 and x1, x1, #0xffffffff
Simon Glassc70f74a2016-11-07 08:47:09 -070068 cmp x1, #R_AARCH64_RELATIVE
David Feng0ae76532013-12-14 11:47:35 +080069 bne fixnext
70
71 /* relative fix: store addend plus offset at dest location */
72 add x0, x0, x9
73 add x4, x4, x9
74 str x4, [x0]
75fixnext:
76 cmp x2, x3
77 b.lo fixloop
78
79relocate_done:
York Sun83571bc2014-02-26 13:26:03 -080080 switch_el x1, 3f, 2f, 1f
81 bl hang
823: mrs x0, sctlr_el3
83 b 0f
842: mrs x0, sctlr_el2
85 b 0f
861: mrs x0, sctlr_el1
870: tbz w0, #2, 5f /* skip flushing cache if disabled */
Masahiro Yamada1f4f5e52017-02-04 12:30:06 +090088 tbz w0, #12, 4f /* skip invalidating i-cache if disabled */
York Sun83571bc2014-02-26 13:26:03 -080089 ic iallu /* i-cache invalidate all */
90 isb sy
914: ldp x0, x1, [sp, #16]
92 bl __asm_flush_dcache_range
Meenakshi Aggarwalb3b77062019-02-19 00:08:30 +053093 bl __asm_flush_l3_dcache
zijun_hu7baf952f2017-09-23 13:30:58 +0800945: ldp x29, x30, [sp],#32
David Feng0ae76532013-12-14 11:47:35 +080095 ret
96ENDPROC(relocate_code)