2017-08-17 09:48:50 +00:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2015-2016 Freescale Semiconductor, Inc.
|
|
|
|
* Copyright 2017 NXP
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
|
|
*/
|
|
|
|
|
2015-10-23 02:13:04 +00: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 04:38:44 +00:00
|
|
|
push {r4, r5, lr}
|
2015-10-23 02:13:04 +00:00
|
|
|
|
2016-06-19 04:38:44 +00:00
|
|
|
mov r4, r0
|
|
|
|
mov r5, r1
|
2015-10-23 02:13:04 +00:00
|
|
|
mov r0, r1
|
2016-06-19 04:38:44 +00:00
|
|
|
mov r1, r2
|
|
|
|
bl psci_save_target_pc
|
2015-10-23 02:13:04 +00:00
|
|
|
|
2016-06-19 04:38:44 +00:00
|
|
|
mov r0, r4
|
|
|
|
mov r1, r5
|
2015-10-23 02:13:04 +00:00
|
|
|
ldr r2, =psci_cpu_entry
|
|
|
|
bl imx_cpu_on
|
|
|
|
|
2016-06-19 04:38:44 +00:00
|
|
|
pop {r4, r5, pc}
|
2015-10-23 02:13:04 +00: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
|