| Peng Fan | fa85b02 | 2017-08-17 17:48:50 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2015-2016 Freescale Semiconductor, Inc. |
| 3 | * Copyright 2017 NXP |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | */ |
| 7 | |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 8 | #include <config.h> |
| 9 | #include <linux/linkage.h> |
| 10 | |
| 11 | #include <asm/armv7.h> |
| 12 | #include <asm/arch-armv7/generictimer.h> |
| 13 | #include <asm/psci.h> |
| 14 | |
| 15 | .pushsection ._secure.text, "ax" |
| 16 | |
| 17 | .arch_extension sec |
| 18 | |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 19 | .globl psci_cpu_on |
| 20 | psci_cpu_on: |
| Chen-Yu Tsai | 6e6622d | 2016-06-19 12:38:44 +0800 | [diff] [blame] | 21 | push {r4, r5, lr} |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 22 | |
| Chen-Yu Tsai | 6e6622d | 2016-06-19 12:38:44 +0800 | [diff] [blame] | 23 | mov r4, r0 |
| 24 | mov r5, r1 |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 25 | mov r0, r1 |
| Chen-Yu Tsai | 6e6622d | 2016-06-19 12:38:44 +0800 | [diff] [blame] | 26 | mov r1, r2 |
| 27 | bl psci_save_target_pc |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 28 | |
| Chen-Yu Tsai | 6e6622d | 2016-06-19 12:38:44 +0800 | [diff] [blame] | 29 | mov r0, r4 |
| 30 | mov r1, r5 |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 31 | ldr r2, =psci_cpu_entry |
| 32 | bl imx_cpu_on |
| 33 | |
| Chen-Yu Tsai | 6e6622d | 2016-06-19 12:38:44 +0800 | [diff] [blame] | 34 | pop {r4, r5, pc} |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 35 | |
| 36 | .globl psci_cpu_off |
| 37 | psci_cpu_off: |
| 38 | |
| 39 | bl psci_cpu_off_common |
| 40 | bl psci_get_cpu_id |
| 41 | bl imx_cpu_off |
| 42 | |
| 43 | 1: wfi |
| 44 | b 1b |
| 45 | |
| Peng Fan | 7de4703 | 2015-10-23 10:13:04 +0800 | [diff] [blame] | 46 | .popsection |