Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0+ */ |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2013 |
| 4 | * David Feng <fenghua@phytium.com.cn> |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <asm-offsets.h> |
| 8 | #include <config.h> |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 9 | #include <linux/linkage.h> |
| 10 | #include <asm/macro.h> |
| 11 | |
Marek Vasut | c1c6318 | 2025-01-29 22:59:18 +0100 | [diff] [blame] | 12 | .pushsection .text.armv8_switch_to_el2_prep, "ax" |
| 13 | WEAK(armv8_switch_to_el2_prep) |
| 14 | ret |
| 15 | ENDPROC(armv8_switch_to_el2_prep) |
| 16 | .popsection |
| 17 | |
Philipp Tomsich | d15592f | 2017-07-04 10:04:54 +0200 | [diff] [blame] | 18 | .pushsection .text.armv8_switch_to_el2, "ax" |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 19 | ENTRY(armv8_switch_to_el2) |
Marek Vasut | c1c6318 | 2025-01-29 22:59:18 +0100 | [diff] [blame] | 20 | bl armv8_switch_to_el2_prep |
| 21 | nop |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 22 | switch_el x6, 1f, 0f, 0f |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 23 | 0: |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 24 | cmp x5, #ES_TO_AARCH64 |
Alison Wang | f547fca | 2016-11-10 10:49:05 +0800 | [diff] [blame] | 25 | b.eq 2f |
| 26 | /* |
| 27 | * When loading 32-bit kernel, it will jump |
| 28 | * to secure firmware again, and never return. |
| 29 | */ |
| 30 | bl armv8_el2_to_aarch32 |
| 31 | 2: |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 32 | /* |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 33 | * x4 is kernel entry point or switch_to_el1 |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 34 | * if CONFIG_ARMV8_SWITCH_TO_EL1 is defined. |
| 35 | * When running in EL2 now, jump to the |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 36 | * address saved in x4. |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 37 | */ |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 38 | br x4 |
| 39 | 1: armv8_switch_to_el2_m x4, x5, x6 |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 40 | ENDPROC(armv8_switch_to_el2) |
Philipp Tomsich | d15592f | 2017-07-04 10:04:54 +0200 | [diff] [blame] | 41 | .popsection |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 42 | |
Philipp Tomsich | d15592f | 2017-07-04 10:04:54 +0200 | [diff] [blame] | 43 | .pushsection .text.armv8_switch_to_el1, "ax" |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 44 | ENTRY(armv8_switch_to_el1) |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 45 | switch_el x6, 0f, 1f, 0f |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 46 | 0: |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 47 | /* x4 is kernel entry point. When running in EL1 |
| 48 | * now, jump to the address saved in x4. |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 49 | */ |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 50 | br x4 |
Peter Hoyes | 6f4a27d | 2021-08-19 16:53:09 +0100 | [diff] [blame] | 51 | 1: armv8_switch_to_el1_m x4, x5, x6, x7 |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 52 | ENDPROC(armv8_switch_to_el1) |
Philipp Tomsich | d15592f | 2017-07-04 10:04:54 +0200 | [diff] [blame] | 53 | .popsection |
Alison Wang | f547fca | 2016-11-10 10:49:05 +0800 | [diff] [blame] | 54 | |
Philipp Tomsich | d15592f | 2017-07-04 10:04:54 +0200 | [diff] [blame] | 55 | .pushsection .text.armv8_el2_to_aarch32, "ax" |
Alison Wang | f547fca | 2016-11-10 10:49:05 +0800 | [diff] [blame] | 56 | WEAK(armv8_el2_to_aarch32) |
| 57 | ret |
| 58 | ENDPROC(armv8_el2_to_aarch32) |
Philipp Tomsich | d15592f | 2017-07-04 10:04:54 +0200 | [diff] [blame] | 59 | .popsection |