1*4882a593Smuzhiyun/* 2*4882a593Smuzhiyun * Copyright 2016 NXP Semiconductor, Inc. 3*4882a593Smuzhiyun * 4*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+ 5*4882a593Smuzhiyun */ 6*4882a593Smuzhiyun 7*4882a593Smuzhiyun#include <config.h> 8*4882a593Smuzhiyun#include <linux/linkage.h> 9*4882a593Smuzhiyun#include <asm/system.h> 10*4882a593Smuzhiyun#include <asm/macro.h> 11*4882a593Smuzhiyun 12*4882a593SmuzhiyunWEAK(_sec_firmware_entry) 13*4882a593Smuzhiyun /* 14*4882a593Smuzhiyun * x0: Secure Firmware entry point 15*4882a593Smuzhiyun * x1: Exception return address Low 16*4882a593Smuzhiyun * x2: Exception return address High 17*4882a593Smuzhiyun */ 18*4882a593Smuzhiyun 19*4882a593Smuzhiyun /* Save stack pointer for EL2 */ 20*4882a593Smuzhiyun mov x3, sp 21*4882a593Smuzhiyun msr sp_el2, x3 22*4882a593Smuzhiyun 23*4882a593Smuzhiyun /* Set exception return address hold pointer */ 24*4882a593Smuzhiyun adr x4, 1f 25*4882a593Smuzhiyun mov x3, x4 26*4882a593Smuzhiyun#ifdef CONFIG_ARMV8_SEC_FIRMWARE_ERET_ADDR_REVERT 27*4882a593Smuzhiyun rev w3, w3 28*4882a593Smuzhiyun#endif 29*4882a593Smuzhiyun str w3, [x1] 30*4882a593Smuzhiyun lsr x3, x4, #32 31*4882a593Smuzhiyun#ifdef CONFIG_ARMV8_SEC_FIRMWARE_ERET_ADDR_REVERT 32*4882a593Smuzhiyun rev w3, w3 33*4882a593Smuzhiyun#endif 34*4882a593Smuzhiyun str w3, [x2] 35*4882a593Smuzhiyun 36*4882a593Smuzhiyun /* Call SEC monitor */ 37*4882a593Smuzhiyun br x0 38*4882a593Smuzhiyun 39*4882a593Smuzhiyun1: 40*4882a593Smuzhiyun mov x0, #0 41*4882a593Smuzhiyun ret 42*4882a593SmuzhiyunENDPROC(_sec_firmware_entry) 43*4882a593Smuzhiyun 44*4882a593Smuzhiyun#ifdef CONFIG_SEC_FIRMWARE_ARMV8_PSCI 45*4882a593SmuzhiyunENTRY(_sec_firmware_support_psci_version) 46*4882a593Smuzhiyun mov x0, 0x84000000 47*4882a593Smuzhiyun mov x1, 0x0 48*4882a593Smuzhiyun mov x2, 0x0 49*4882a593Smuzhiyun mov x3, 0x0 50*4882a593Smuzhiyun smc #0 51*4882a593Smuzhiyun ret 52*4882a593SmuzhiyunENDPROC(_sec_firmware_support_psci_version) 53*4882a593Smuzhiyun 54*4882a593Smuzhiyun/* 55*4882a593Smuzhiyun * Switch from AArch64 EL2 to AArch32 EL2 56*4882a593Smuzhiyun * @param inputs: 57*4882a593Smuzhiyun * x0: argument, zero 58*4882a593Smuzhiyun * x1: machine nr 59*4882a593Smuzhiyun * x2: fdt address 60*4882a593Smuzhiyun * x3: input argument 61*4882a593Smuzhiyun * x4: kernel entry point 62*4882a593Smuzhiyun * @param outputs for secure firmware: 63*4882a593Smuzhiyun * x0: function id 64*4882a593Smuzhiyun * x1: kernel entry point 65*4882a593Smuzhiyun * x2: machine nr 66*4882a593Smuzhiyun * x3: fdt address 67*4882a593Smuzhiyun*/ 68*4882a593SmuzhiyunENTRY(armv8_el2_to_aarch32) 69*4882a593Smuzhiyun mov x3, x2 70*4882a593Smuzhiyun mov x2, x1 71*4882a593Smuzhiyun mov x1, x4 72*4882a593Smuzhiyun ldr x0, =0xc000ff04 73*4882a593Smuzhiyun smc #0 74*4882a593Smuzhiyun ret 75*4882a593SmuzhiyunENDPROC(armv8_el2_to_aarch32) 76*4882a593Smuzhiyun#endif 77