2018-05-06 21:58:06 +00:00
|
|
|
/* SPDX-License-Identifier: GPL-2.0+ */
|
2013-12-14 03:47:35 +00:00
|
|
|
/*
|
|
|
|
* (C) Copyright 2013
|
|
|
|
* David Feng <fenghua@phytium.com.cn>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <asm-offsets.h>
|
|
|
|
#include <config.h>
|
|
|
|
#include <linux/linkage.h>
|
|
|
|
#include <asm/macro.h>
|
|
|
|
|
2017-07-04 08:04:54 +00:00
|
|
|
.pushsection .text.armv8_switch_to_el2, "ax"
|
2013-12-14 03:47:35 +00:00
|
|
|
ENTRY(armv8_switch_to_el2)
|
2017-01-17 01:39:17 +00:00
|
|
|
switch_el x6, 1f, 0f, 0f
|
2016-11-10 02:49:03 +00:00
|
|
|
0:
|
2017-01-17 01:39:17 +00:00
|
|
|
cmp x5, #ES_TO_AARCH64
|
2016-11-10 02:49:05 +00:00
|
|
|
b.eq 2f
|
|
|
|
/*
|
|
|
|
* When loading 32-bit kernel, it will jump
|
|
|
|
* to secure firmware again, and never return.
|
|
|
|
*/
|
|
|
|
bl armv8_el2_to_aarch32
|
|
|
|
2:
|
2016-11-10 02:49:03 +00:00
|
|
|
/*
|
2017-01-17 01:39:17 +00:00
|
|
|
* x4 is kernel entry point or switch_to_el1
|
2016-11-10 02:49:03 +00:00
|
|
|
* if CONFIG_ARMV8_SWITCH_TO_EL1 is defined.
|
|
|
|
* When running in EL2 now, jump to the
|
2017-01-17 01:39:17 +00:00
|
|
|
* address saved in x4.
|
2016-11-10 02:49:03 +00:00
|
|
|
*/
|
2017-01-17 01:39:17 +00:00
|
|
|
br x4
|
|
|
|
1: armv8_switch_to_el2_m x4, x5, x6
|
2013-12-14 03:47:35 +00:00
|
|
|
ENDPROC(armv8_switch_to_el2)
|
2017-07-04 08:04:54 +00:00
|
|
|
.popsection
|
2013-12-14 03:47:35 +00:00
|
|
|
|
2017-07-04 08:04:54 +00:00
|
|
|
.pushsection .text.armv8_switch_to_el1, "ax"
|
2013-12-14 03:47:35 +00:00
|
|
|
ENTRY(armv8_switch_to_el1)
|
2017-01-17 01:39:17 +00:00
|
|
|
switch_el x6, 0f, 1f, 0f
|
2016-11-10 02:49:03 +00:00
|
|
|
0:
|
2017-01-17 01:39:17 +00:00
|
|
|
/* x4 is kernel entry point. When running in EL1
|
|
|
|
* now, jump to the address saved in x4.
|
2016-11-10 02:49:03 +00:00
|
|
|
*/
|
2017-01-17 01:39:17 +00:00
|
|
|
br x4
|
|
|
|
1: armv8_switch_to_el1_m x4, x5, x6
|
2013-12-14 03:47:35 +00:00
|
|
|
ENDPROC(armv8_switch_to_el1)
|
2017-07-04 08:04:54 +00:00
|
|
|
.popsection
|
2016-11-10 02:49:05 +00:00
|
|
|
|
2017-07-04 08:04:54 +00:00
|
|
|
.pushsection .text.armv8_el2_to_aarch32, "ax"
|
2016-11-10 02:49:05 +00:00
|
|
|
WEAK(armv8_el2_to_aarch32)
|
|
|
|
ret
|
|
|
|
ENDPROC(armv8_el2_to_aarch32)
|
2017-07-04 08:04:54 +00:00
|
|
|
.popsection
|