git.sur5r.net Git - u-boot/blob - arch/arm/cpu/armv7/mx7/psci.S

   1 #include <config.h>
   2 #include <linux/linkage.h>
   3
   4 #include <asm/armv7.h>
   5 #include <asm/arch-armv7/generictimer.h>
   6 #include <asm/psci.h>
   7
   8         .pushsection ._secure.text, "ax"
   9
  10         .arch_extension sec
  11
  12         @ r1 = target CPU
  13         @ r2 = target PC
  14
  15 .globl  psci_arch_init
  16 psci_arch_init:
  17         mov     r6, lr
  18
  19         bl      psci_get_cpu_id
  20         bl      psci_get_cpu_stack_top
  21         mov     sp, r0
  22
  23         bx      r6
  24
  25         @ r1 = target CPU
  26         @ r2 = target PC
  27
  28 .globl psci_cpu_on
  29 psci_cpu_on:
  30         push    {lr}
  31
  32         mov     r0, r1
  33         bl      psci_get_cpu_stack_top
  34         str     r2, [r0]
  35         dsb
  36
  37         ldr     r2, =psci_cpu_entry
  38         bl      imx_cpu_on
  39
  40         pop     {pc}
  41
  42 .globl psci_cpu_off
  43 psci_cpu_off:
  44
  45         bl      psci_cpu_off_common
  46         bl      psci_get_cpu_id
  47         bl      imx_cpu_off
  48
  49 1:      wfi
  50         b 1b
  51
  52         .globl psci_text_end
  53 psci_text_end:
  54         .popsection