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