[J-u-boot.git] / arch / arm / mach-socfpga / secure_reg_helper.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2020 Intel Corporation <www.intel.com>
 *
 */

#include <common.h>
#include <hang.h>
#include <asm/io.h>
#include <asm/system.h>
#include <asm/arch/misc.h>
#include <asm/arch/secure_reg_helper.h>
#include <asm/arch/smc_api.h>
#include <asm/arch/system_manager.h>
#include <linux/errno.h>
#include <linux/intel-smc.h>

int socfpga_secure_convert_reg_id_to_addr(u32 id, phys_addr_t *reg_addr)
{
	switch (id) {
	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_SDMMC:
		*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_SDMMC;
		break;
	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_EMAC0:
		*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_EMAC0;
		break;
	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_EMAC1:
		*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_EMAC1;
		break;
	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_EMAC2:
		*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_EMAC2;
		break;
	default:
		return -EADDRNOTAVAIL;
	}
	return 0;
}

int socfpga_secure_reg_read32(u32 id, u32 *val)
{
	int ret;
	u64 ret_arg;
	u64 args[1];

	phys_addr_t reg_addr;
	ret = socfpga_secure_convert_reg_id_to_addr(id, &reg_addr);
	if (ret)
		return ret;

	args[0] = (u64)reg_addr;
	ret = invoke_smc(INTEL_SIP_SMC_REG_READ, args, 1, &ret_arg, 1);
	if (ret)
		return ret;

	*val = (u32)ret_arg;

	return 0;
}

int socfpga_secure_reg_write32(u32 id, u32 val)
{
	int ret;
	u64 args[2];

	phys_addr_t reg_addr;
	ret = socfpga_secure_convert_reg_id_to_addr(id, &reg_addr);
	if (ret)
		return ret;

	args[0] = (u64)reg_addr;
	args[1] = val;
	return invoke_smc(INTEL_SIP_SMC_REG_WRITE, args, 2, NULL, 0);
}

int socfpga_secure_reg_update32(u32 id, u32 mask, u32 val)
{
	int ret;
	u64 args[3];

	phys_addr_t reg_addr;
	ret = socfpga_secure_convert_reg_id_to_addr(id, &reg_addr);
	if (ret)
		return ret;

	args[0] = (u64)reg_addr;
	args[1] = mask;
	args[2] = val;
	return invoke_smc(INTEL_SIP_SMC_REG_UPDATE, args, 3, NULL, 0);
}
Commit	Line	Data
2e54a1d4 SCL	1	// SPDX-License-Identifier: GPL-2.0
	2	/*
	3	* Copyright (C) 2020 Intel Corporation <www.intel.com>
	4	*
	5	*/
	6
	7	#include <common.h>
	8	#include <hang.h>
	9	#include <asm/io.h>
	10	#include <asm/system.h>
	11	#include <asm/arch/misc.h>
	12	#include <asm/arch/secure_reg_helper.h>
	13	#include <asm/arch/smc_api.h>
	14	#include <asm/arch/system_manager.h>
	15	#include <linux/errno.h>
	16	#include <linux/intel-smc.h>
	17
	18	int socfpga_secure_convert_reg_id_to_addr(u32 id, phys_addr_t *reg_addr)
	19	{
	20	switch (id) {
	21	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_SDMMC:
	22	*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_SDMMC;
	23	break;
	24	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_EMAC0:
	25	*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_EMAC0;
	26	break;
	27	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_EMAC1:
	28	*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_EMAC1;
	29	break;
	30	case SOCFPGA_SECURE_REG_SYSMGR_SOC64_EMAC2:
	31	*reg_addr = socfpga_get_sysmgr_addr() + SYSMGR_SOC64_EMAC2;
	32	break;
	33	default:
	34	return -EADDRNOTAVAIL;
	35	}
	36	return 0;
	37	}
	38
	39	int socfpga_secure_reg_read32(u32 id, u32 *val)
	40	{
	41	int ret;
	42	u64 ret_arg;
	43	u64 args[1];
	44
	45	phys_addr_t reg_addr;
	46	ret = socfpga_secure_convert_reg_id_to_addr(id, &reg_addr);
	47	if (ret)
	48	return ret;
	49
	50	args[0] = (u64)reg_addr;
	51	ret = invoke_smc(INTEL_SIP_SMC_REG_READ, args, 1, &ret_arg, 1);
	52	if (ret)
	53	return ret;
	54
	55	*val = (u32)ret_arg;
	56
	57	return 0;
	58	}
	59
	60	int socfpga_secure_reg_write32(u32 id, u32 val)
	61	{
	62	int ret;
	63	u64 args[2];
	64
65	phys_addr_t reg_addr;
66	ret = socfpga_secure_convert_reg_id_to_addr(id, &reg_addr);
67	if (ret)
68	return ret;
69
70	args[0] = (u64)reg_addr;
71	args[1] = val;
72	return invoke_smc(INTEL_SIP_SMC_REG_WRITE, args, 2, NULL, 0);
73	}
74
75	int socfpga_secure_reg_update32(u32 id, u32 mask, u32 val)
76	{
77	int ret;
78	u64 args[3];
79
80	phys_addr_t reg_addr;
81	ret = socfpga_secure_convert_reg_id_to_addr(id, &reg_addr);
82	if (ret)
83	return ret;
84
85	args[0] = (u64)reg_addr;
86	args[1] = mask;
87	args[2] = val;
88	return invoke_smc(INTEL_SIP_SMC_REG_UPDATE, args, 3, NULL, 0);
89	}