2015-10-23 10:13:04 +08:00
|
|
|
#include <config.h>
|
|
|
|
#include <linux/linkage.h>
|
|
|
|
|
|
|
|
#include <asm/armv7.h>
|
|
|
|
#include <asm/arch-armv7/generictimer.h>
|
|
|
|
#include <asm/psci.h>
|
|
|
|
|
|
|
|
.pushsection ._secure.text, "ax"
|
|
|
|
|
|
|
|
.arch_extension sec
|
|
|
|
|
|
|
|
.globl psci_cpu_on
|
|
|
|
psci_cpu_on:
|
2016-06-19 12:38:44 +08:00
|
|
|
push {r4, r5, lr}
|
2015-10-23 10:13:04 +08:00
|
|
|
|
2016-06-19 12:38:44 +08:00
|
|
|
mov r4, r0
|
|
|
|
mov r5, r1
|
2015-10-23 10:13:04 +08:00
|
|
|
mov r0, r1
|
2016-06-19 12:38:44 +08:00
|
|
|
mov r1, r2
|
|
|
|
bl psci_save_target_pc
|
2015-10-23 10:13:04 +08:00
|
|
|
|
2016-06-19 12:38:44 +08:00
|
|
|
mov r0, r4
|
|
|
|
mov r1, r5
|
2015-10-23 10:13:04 +08:00
|
|
|
ldr r2, =psci_cpu_entry
|
|
|
|
bl imx_cpu_on
|
|
|
|
|
2016-06-19 12:38:44 +08:00
|
|
|
pop {r4, r5, pc}
|
2015-10-23 10:13:04 +08:00
|
|
|
|
|
|
|
.globl psci_cpu_off
|
|
|
|
psci_cpu_off:
|
|
|
|
|
|
|
|
bl psci_cpu_off_common
|
|
|
|
bl psci_get_cpu_id
|
|
|
|
bl imx_cpu_off
|
|
|
|
|
|
|
|
1: wfi
|
|
|
|
b 1b
|
|
|
|
|
|
|
|
.popsection
|