Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit d0826b0b authored by Amir Samuelov's avatar Amir Samuelov
Browse files

soc: qcom: spss_utils: read spu uefi apps calculated cmac 



The spu firmware and 3 apps are loaded by UEFI.
The spu calculates the apps cmac and compares with
the saved cmac. on mismatch the spu perform CE.
The SPU stores the calculated cmac in shared memory.
This driver reads the new calculated cmac from memory.
The spu daemon will fetch them during boot via sysfs
and save them in the file system.

Change-Id: I03660670b54d86b6b6f4b8db891834d8f6b8dcc3
Signed-off-by: default avatarAmir Samuelov <amirs@codeaurora.org>
parent 773b595b

drivers/soc/qcom/spss_utils.c

+59 −47
Original line number Diff line number Diff line
@@ -63,15 +63,21 @@ static u32 spss_emul_type_reg_addr; /* TCSR_SOC_EMULATION_TYPE */ 
static void *iar_notif_handle;

static struct notifier_block *iar_nb;



#define CMAC_SIZE_IN_BYTES (128/8) /* 128 bit */

#define CMAC_SIZE_IN_BYTES (128/8) /* 128 bit = 16 bytes */

#define CMAC_SIZE_IN_DWORDS (CMAC_SIZE_IN_BYTES/sizeof(u32)) /* 4 dwords */



/* Asym , Crypt , Keym */

#define NUM_UEFI_APPS 3



static u32 pil_addr;

static u32 pil_size;

static u32 cmac_buf[CMAC_SIZE_IN_BYTES/sizeof(u32)]; /* saved cmac */

static u32 pbl_cmac_buf[CMAC_SIZE_IN_BYTES/sizeof(u32)]; /* pbl cmac */

static u32 cmac_buf[CMAC_SIZE_IN_DWORDS]; /* saved cmac */

static u32 pbl_cmac_buf[CMAC_SIZE_IN_DWORDS]; /* pbl cmac */



static u32 apps_cmac_buf[NUM_UEFI_APPS][CMAC_SIZE_IN_DWORDS];



static u32 iar_state;

static bool is_iar_enabled;

static bool is_pbl_ce; /* Did SPU PBL performed Cryptographic Erase (CE) */



static void __iomem *cmac_mem;

static size_t cmac_mem_size = SZ_4K; /* XPU align to 4KB */
@@ -97,7 +103,7 @@ static struct spss_utils_device *spss_utils_dev; 


/* static functions declaration */

static int spss_set_fw_cmac(u32 *cmac, size_t cmac_size);

static int spss_get_pbl_calc_cmac(u32 *cmac, size_t cmac_size);

static int spss_get_pbl_and_apps_calc_cmac(void);



/*==========================================================================*/

/*		Device Sysfs */
@@ -245,7 +251,7 @@ static ssize_t iar_enabled_show(struct device *dev, 


static DEVICE_ATTR_RO(iar_enabled);



static ssize_t pbl_ce_show(struct device *dev,

static ssize_t pbl_cmac_show(struct device *dev,

		struct device_attribute *attr,

		char *buf)

{
@@ -256,31 +262,28 @@ static ssize_t pbl_ce_show(struct device *dev, 
		return -EINVAL;

	}



	ret = snprintf(buf, PAGE_SIZE, "0x%x\n", is_pbl_ce);

	ret = snprintf(buf, PAGE_SIZE, "0x%08x,0x%08x,0x%08x,0x%08x\n",

	    pbl_cmac_buf[0], pbl_cmac_buf[1], pbl_cmac_buf[2], pbl_cmac_buf[3]);



	return ret;

}



static DEVICE_ATTR_RO(pbl_ce);

static DEVICE_ATTR_RO(pbl_cmac);



static ssize_t pbl_cmac_show(struct device *dev,

		struct device_attribute *attr,

		char *buf)

static ssize_t apps_cmac_show(struct device *dev,

	struct device_attribute *attr, char *buf)

{

	int ret = 0;



	if (!dev || !attr || !buf) {

		pr_err("invalid param.\n");

		return -EINVAL;

	}



	ret = snprintf(buf, PAGE_SIZE, "0x%08x,0x%08x,0x%08x,0x%08x\n",

	    pbl_cmac_buf[0], pbl_cmac_buf[1], pbl_cmac_buf[2], pbl_cmac_buf[3]);

	memcpy(buf, apps_cmac_buf, sizeof(apps_cmac_buf));



	return ret;

	return sizeof(apps_cmac_buf);

}



static DEVICE_ATTR_RO(pbl_cmac);

static DEVICE_ATTR_RO(apps_cmac);



/*--------------------------------------------------------------------------*/

static int spss_create_sysfs(struct device *dev)
@@ -323,22 +326,23 @@ static int spss_create_sysfs(struct device *dev) 
		goto remove_iar_state;

	}



	ret = device_create_file(dev, &dev_attr_pbl_ce);

	ret = device_create_file(dev, &dev_attr_pbl_cmac);

	if (ret < 0) {

		pr_err("failed to create sysfs file for pbl_ce.\n");

		pr_err("failed to create sysfs file for pbl_cmac.\n");

		goto remove_iar_enabled;

	}



	ret = device_create_file(dev, &dev_attr_pbl_cmac);

	ret = device_create_file(dev, &dev_attr_apps_cmac);

	if (ret < 0) {

		pr_err("failed to create sysfs file for pbl_cmac.\n");

		goto remove_pbl_ce;

		pr_err("failed to create sysfs file for apps_cmac.\n");

		goto remove_pbl_cmac;

	}





	return 0;



remove_pbl_ce:

		device_remove_file(dev, &dev_attr_pbl_ce);

remove_pbl_cmac:

		device_remove_file(dev, &dev_attr_pbl_cmac);

remove_iar_enabled:

		device_remove_file(dev, &dev_attr_iar_enabled);

remove_iar_state:
@@ -399,20 +403,12 @@ static long spss_utils_ioctl(struct file *file, 
		/*

		 * SPSS is loaded now by UEFI,

		 * so IAR callback is not being called on powerup by PIL.

		 * therefore read the spu pbl fw cmac from ioctl.

		 * therefore read the spu pbl fw cmac and apps cmac from ioctl.

		 * The callback shall be called on spss SSR.

		 */

		pr_debug("read pbl cmac from shared memory\n");

		spss_set_fw_cmac(cmac_buf, sizeof(cmac_buf));

		spss_get_pbl_calc_cmac(pbl_cmac_buf, sizeof(pbl_cmac_buf));

		if (memcmp(cmac_buf, pbl_cmac_buf, sizeof(cmac_buf)) != 0)

			is_pbl_ce = true; /* cmacs not the same */

		else

			is_pbl_ce = false;



		pr_info("calc fw cmac: 0x%08x,0x%08x,0x%08x,0x%08x\n",

			pbl_cmac_buf[0], pbl_cmac_buf[1],

			pbl_cmac_buf[2], pbl_cmac_buf[3]);

		spss_get_pbl_and_apps_calc_cmac();

		break;



	default:
@@ -781,23 +777,43 @@ static int spss_set_fw_cmac(u32 *cmac, size_t cmac_size) 
	return 0;

}



static int spss_get_pbl_calc_cmac(u32 *cmac, size_t cmac_size)

static int spss_get_pbl_and_apps_calc_cmac(void)

{

	u8 __iomem *reg = NULL;

	int i;

	int i, j;

	u32 val;



	if (cmac_mem == NULL)

		return -EFAULT;



	/* PBL calculated cmac after HLOS expected cmac */

	reg = cmac_mem + cmac_size;

	reg = cmac_mem; /* IAR buffer base */

	reg += CMAC_SIZE_IN_BYTES; /* skip the saved cmac */

	pr_debug("reg [%pK]\n", reg);



	for (i = 0; i < cmac_size/4; i++) {

		val = readl_relaxed(reg + i*sizeof(u32));

		cmac[i] = val;

		pr_debug("cmac[%d] [0x%x]\n", (int) i, (int) val);

	/* get pbl fw cmac from ddr */

	for (i = 0; i < CMAC_SIZE_IN_DWORDS; i++) {

		val = readl_relaxed(reg);

		pbl_cmac_buf[i] = val;

		reg += sizeof(u32);

	}

	reg += CMAC_SIZE_IN_BYTES; /* skip the saved cmac */



	pr_info("pbl_cmac_buf : 0x%08x,0x%08x,0x%08x,0x%08x\n",

	    pbl_cmac_buf[0], pbl_cmac_buf[1],

	    pbl_cmac_buf[2], pbl_cmac_buf[3]);



	/* get apps cmac from ddr */

	for (j = 0; j < NUM_UEFI_APPS; j++) {

		for (i = 0; i < CMAC_SIZE_IN_DWORDS; i++) {

			val = readl_relaxed(reg);

			apps_cmac_buf[j][i] = val;

			reg += sizeof(u32);

		}

		reg += CMAC_SIZE_IN_BYTES; /* skip the saved cmac */



		pr_info("app [%d] cmac : 0x%08x,0x%08x,0x%08x,0x%08x\n", j,

			apps_cmac_buf[j][0], apps_cmac_buf[j][1],

			apps_cmac_buf[j][2], apps_cmac_buf[j][3]);

	}



	return 0;
@@ -820,11 +836,7 @@ static int spss_utils_iar_callback(struct notifier_block *nb, 
		break;

	case SUBSYS_AFTER_POWERUP:

		pr_debug("[SUBSYS_AFTER_POWERUP] event.\n");

		spss_get_pbl_calc_cmac(pbl_cmac_buf, sizeof(pbl_cmac_buf));

		if (memcmp(cmac_buf, pbl_cmac_buf, sizeof(cmac_buf)) != 0)

			is_pbl_ce = true; /* cmacs not the same */

		else

			is_pbl_ce = false;

		spss_get_pbl_and_apps_calc_cmac();

		break;

	case SUBSYS_BEFORE_AUTH_AND_RESET:

		pr_debug("[SUBSYS_BEFORE_AUTH_AND_RESET] event.\n");