arch/arm/lib/relocate_64.S

   1 /*
   2  * relocate - common relocation function for AArch64 U-Boot
   3  *
   4  * (C) Copyright 2013
   5  * Albert ARIBAUD <albert.u.boot@aribaud.net>
   6  * David Feng <fenghua@phytium.com.cn>
   7  *
   8  * SPDX-License-Identifier:     GPL-2.0+
   9  */
  10
  11 #include <asm-offsets.h>
  12 #include <config.h>
  13 #include <elf.h>
  14 #include <linux/linkage.h>
  15 #include <asm/macro.h>
  16
  17 /*
  18  * void relocate_code (addr_moni)
  19  *
  20  * This function relocates the monitor code.
  21  * x0 holds the destination address.
  22  */
  23 ENTRY(relocate_code)
  24         stp     x29, x30, [sp, #-32]!   /* create a stack frame */
  25         mov     x29, sp
  26         str     x0, [sp, #16]
  27         /*
  28          * Copy u-boot from flash to RAM
  29          */
  30         ldr     x1, =__image_copy_start /* x1 <- SRC &__image_copy_start */
  31         subs    x9, x0, x1              /* x9 <- relocation offset */
  32         b.eq    relocate_done           /* skip relocation */
  33         ldr     x2, =__image_copy_end   /* x2 <- SRC &__image_copy_end */
  34
  35 copy_loop:
  36         ldp     x10, x11, [x1], #16     /* copy from source address [x1] */
  37         stp     x10, x11, [x0], #16     /* copy to   target address [x0] */
  38         cmp     x1, x2                  /* until source end address [x2] */
  39         b.lo    copy_loop
  40         str     x0, [sp, #24]
  41
  42         /*
  43          * Fix .rela.dyn relocations
  44          */
  45         ldr     x2, =__rel_dyn_start    /* x2 <- SRC &__rel_dyn_start */
  46         ldr     x3, =__rel_dyn_end      /* x3 <- SRC &__rel_dyn_end */
  47 fixloop:
  48         ldp     x0, x1, [x2], #16       /* (x0,x1) <- (SRC location, fixup) */
  49         ldr     x4, [x2], #8            /* x4 <- addend */
  50         and     x1, x1, #0xffffffff
  51         cmp     x1, #R_AARCH64_RELATIVE
  52         bne     fixnext
  53
  54         /* relative fix: store addend plus offset at dest location */
  55         add     x0, x0, x9
  56         add     x4, x4, x9
  57         str     x4, [x0]
  58 fixnext:
  59         cmp     x2, x3
  60         b.lo    fixloop
  61
  62 relocate_done:
  63         switch_el x1, 3f, 2f, 1f
  64         bl      hang
  65 3:      mrs     x0, sctlr_el3
  66         b       0f
  67 2:      mrs     x0, sctlr_el2
  68         b       0f
  69 1:      mrs     x0, sctlr_el1
  70 0:      tbz     w0, #2, 5f      /* skip flushing cache if disabled */
  71         tbz     w0, #12, 4f     /* skip invalidating i-cache if disabled */
  72         ic      iallu           /* i-cache invalidate all */
  73         isb     sy
  74 4:      ldp     x0, x1, [sp, #16]
  75         bl      __asm_flush_dcache_range
  76 5:      ldp     x29, x30, [sp],#16
  77         ret
  78 ENDPROC(relocate_code)