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 | |
| 13 | ENTRY(armv8_switch_to_el2) |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 14 | switch_el x6, 1f, 0f, 0f |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 15 | 0: |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 16 | cmp x5, #ES_TO_AARCH64 |
Alison Wang | f547fca | 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 | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 24 | /* |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 25 | * x4 is kernel entry point or switch_to_el1 |
Alison Wang | 73818d5 | 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 | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 28 | * address saved in x4. |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 29 | */ |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 30 | br x4 |
| 31 | 1: armv8_switch_to_el2_m x4, x5, x6 |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 32 | ENDPROC(armv8_switch_to_el2) |
| 33 | |
| 34 | ENTRY(armv8_switch_to_el1) |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 35 | switch_el x6, 0f, 1f, 0f |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 36 | 0: |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 37 | /* x4 is kernel entry point. When running in EL1 |
| 38 | * now, jump to the address saved in x4. |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 39 | */ |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 40 | br x4 |
| 41 | 1: armv8_switch_to_el1_m x4, x5, x6 |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 42 | ENDPROC(armv8_switch_to_el1) |
Alison Wang | f547fca | 2016-11-10 10:49:05 +0800 | [diff] [blame] | 43 | |
| 44 | WEAK(armv8_el2_to_aarch32) |
| 45 | ret |
| 46 | ENDPROC(armv8_el2_to_aarch32) |