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