lineage_kernel_xcoverpro/drivers/soc/samsung/exynos-el3_mon.c

261 lines
6.4 KiB
C
Executable File

/*
* Copyright (c) 2015 Samsung Electronics Co., Ltd.
* http://www.samsung.com/
*
* EXYNOS - EL3 monitor support
* Author: Jang Hyunsung <hs79.jang@samsung.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*/
#include <linux/slab.h>
#include <linux/smc.h>
#include <asm/cacheflush.h>
#include <asm/memory.h>
#include <soc/samsung/exynos-el3_mon.h>
static char *smc_debug_mem;
#ifdef CONFIG_EXYNOS_KERNEL_PROTECTION
static int __init exynos_protect_kernel_text(void)
{
int ret = 0;
unsigned long ktext_start_va = 0;
unsigned long ktext_start_pa = 0;
unsigned long ktext_end_va = 0;
unsigned long ktext_end_pa = 0;
/* Get virtual addresses of kernel text */
ktext_start_va = (unsigned long)_text;
if (!ktext_start_va) {
pr_err("%s: [ERROR] Kernel text start address is invalid\n",
__func__);
return -1;
}
ktext_end_va = (unsigned long)_etext;
if (!ktext_end_va) {
pr_err("%s: [ERROR] Kernel text end address is invalid\n",
__func__);
return -1;
}
/* Translate VA to PA */
ktext_start_pa = (unsigned long)__pa_symbol(_text);
ktext_end_pa = (unsigned long)__pa_symbol(_etext);
pr_info("%s: Kernel text start VA(%#lx), PA(%#lx)\n",
__func__, ktext_start_va, ktext_start_pa);
pr_info("%s: Kernel text end VA(%#lx), PA(%#lx)\n",
__func__, ktext_end_va, ktext_end_pa);
/* Request to protect kernel text area */
ret = exynos_smc(SMC_CMD_PROTECT_KERNEL_TEXT,
ktext_start_pa,
ktext_end_pa,
0);
if (ret) {
switch (ret) {
case EXYNOS_ERROR_NOT_VALID_ADDRESS:
pr_err("%s: [ERROR] Invalid address\n", __func__);
break;
case EXYNOS_ERROR_TZASC_WRONG_REGION:
pr_err("%s: [ERROR] Wrong TZASC region\n", __func__);
break;
case EXYNOS_ERROR_ALREADY_INITIALIZED:
pr_err("%s: [ERROR] Already initialized\n", __func__);
break;
default:
pr_err("%s: [ERROR] Unknown error [ret = %#x]\n",
__func__, ret);
break;
}
return ret;
}
pr_info("%s: Success to set Kernel code as read-only\n", __func__);
return 0;
}
core_initcall(exynos_protect_kernel_text);
#endif
static int __init exynos_set_debug_mem(void)
{
int ret;
char *phys;
unsigned int size = PAGE_SIZE * 2;
smc_debug_mem = kmalloc(size, GFP_KERNEL);
if (!smc_debug_mem) {
pr_err("%s: kmalloc for smc_debug failed.\n", __func__);
return 0;
}
/* to map & flush memory */
memset(smc_debug_mem, 0x00, size);
__flush_dcache_area(smc_debug_mem, size);
phys = (char *)virt_to_phys(smc_debug_mem);
pr_err("%s: alloc kmem for smc_dbg virt: 0x%p phys: 0x%p size: %d.\n",
__func__, smc_debug_mem, phys, size);
ret = exynos_smc(SMC_CMD_SET_DEBUG_MEM, (u64)phys, (u64)size, 0);
/* correct return value is input size */
if (ret != size) {
pr_err("%s: Can not set the address to el3 monitor. "
"ret = 0x%x. free the kmem\n", __func__, ret);
kfree(smc_debug_mem);
}
return 0;
}
arch_initcall(exynos_set_debug_mem);
static void exynos_smart_exception_handler(unsigned int id,
unsigned long elr, unsigned long esr,
unsigned long sctlr, unsigned long ttbr,
unsigned long tcr, unsigned long x6,
unsigned int offset)
{
int i;
unsigned long *ptr;
unsigned long tmp;
pr_err("========================================="
"=========================================\n");
if (id)
pr_err("%s: There has been an unexpected exception from "
"a LDFW which has smc id 0x%x\n\n", __func__, id);
else
pr_err("%s: There has been an unexpected exception from "
"the EL3 monitor.\n\n", __func__);
if (id) {
pr_err("elr_el1 : 0x%016lx, \tesr_el1 : 0x%016lx\n",
elr, esr);
pr_err("sctlr_el1 : 0x%016lx, \tttbr_el1 : 0x%016lx\n",
sctlr, ttbr);
pr_err("tcr_el1 : 0x%016lx, \tlr (EL1) : 0x%016lx\n\n",
tcr, x6);
} else {
pr_err("elr_el3 : 0x%016lx, \tesr_el3 : 0x%016lx\n",
elr, esr);
pr_err("sctlr_el3 : 0x%016lx, \tttbr_el3 : 0x%016lx\n",
sctlr, ttbr);
pr_err("tcr_el3 : 0x%016lx, \tscr_el3 : 0x%016lx\n\n",
tcr, x6);
if ((offset > 0x0 && offset < (PAGE_SIZE * 2))
&& !(offset % 0x8) && (smc_debug_mem)) {
/* Invalidate smc_debug_mem for cache coherency */
__inval_dcache_area(smc_debug_mem, PAGE_SIZE * 2);
tmp = (unsigned long)smc_debug_mem;
tmp += (unsigned long)offset;
ptr = (unsigned long *)tmp;
for (i = 0; i < 15; i++) {
pr_err("x%02d : 0x%016lx, \tx%02d : 0x%016lx\n",
i * 2, ptr[i * 2],
i * 2 + 1, ptr[i * 2 + 1]);
}
pr_err("x%02d : 0x%016lx\n", i * 2, ptr[i * 2]);
}
}
pr_err("\n[WARNING] IT'S GOING TO CAUSE KERNEL PANIC FOR DEBUGGING.\n\n");
pr_err("========================================="
"=========================================\n");
/* make kernel panic */
BUG();
/* SHOULD NOT be here */
while(1);
}
static int __init exynos_set_seh_address(void)
{
int ret;
unsigned long addr = (unsigned long)exynos_smart_exception_handler;
pr_info("%s: send smc call with SMC_CMD_SET_SEH_ADDRESS.\n", __func__);
ret = exynos_smc(SMC_CMD_SET_SEH_ADDRESS, addr, 0, 0);
/* return value not zero means failure */
if (ret)
pr_err("%s: did not set the seh address to el3 monitor. "
"ret = 0x%x.\n", __func__, ret);
else
pr_err("%s: set the seh address to el3 monitor well.\n",
__func__);
return 0;
}
arch_initcall(exynos_set_seh_address);
/*
* The function to save TZPC of power domains
* by calling SMC to EL3 Monitor
*
* Power domains for runtime PM
*/
int exynos_pd_tz_save(unsigned int addr)
{
return exynos_smc(SMC_CMD_PREAPRE_PD_ONOFF,
EXYNOS_GET_IN_PD_DOWN,
addr,
EXYNOS_PD_RUNTIME_PM);
}
/*
* The function to restore TZPC of power domains
* by calling SMC to EL3 Monitor
*
* Power domains for runtime PM
*/
int exynos_pd_tz_restore(unsigned int addr)
{
return exynos_smc(SMC_CMD_PREAPRE_PD_ONOFF,
EXYNOS_WAKEUP_PD_DOWN,
addr,
EXYNOS_PD_RUNTIME_PM);
}
/*
* The function to save TZPC of power domain
* by calling SMC to EL3 Monitor
*
* Power domains for connectivity
*/
int exynos_conn_tz_save(unsigned int addr)
{
return exynos_smc(SMC_CMD_PREAPRE_PD_ONOFF,
EXYNOS_GET_IN_PD_DOWN,
addr,
EXYNOS_PD_CONNECTIVITY);
}
/*
* The function to restore TZPC of power domain
* by calling SMC to EL3 Monitor
*
* Power domains for connectivity
*/
int exynos_conn_tz_restore(unsigned int addr)
{
return exynos_smc(SMC_CMD_PREAPRE_PD_ONOFF,
EXYNOS_WAKEUP_PD_DOWN,
addr,
EXYNOS_PD_CONNECTIVITY);
}