RE: [PATCH V4 3/4] nvmem: zynqmp_nvmem: Add support to access efuse

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 




>-----Original Message-----
>From: Praveen Teja Kundanala <praveen.teja.kundanala@xxxxxxx>
>Sent: Friday, February 2, 2024 5:09 PM
>To: srinivas.kandagatla@xxxxxxxxxx; Simek, Michal <michal.simek@xxxxxxx>;
>Akula, Kalyani <kalyani.akula@xxxxxxx>; Kundanala, Praveen Teja
><praveen.teja.kundanala@xxxxxxx>; devicetree@xxxxxxxxxxxxxxx; linux-arm-
>kernel@xxxxxxxxxxxxxxxxxxx
>Cc: linux-kernel@xxxxxxxxxxxxxxx
>Subject: [PATCH V4 3/4] nvmem: zynqmp_nvmem: Add support to access efuse
>
>Add support to read/write efuse memory map of ZynqMP.
>Below are the offsets of ZynqMP efuse memory map
>	0 - SOC version(read only)
>	0xC - 0xFC -ZynqMP specific purpose efuses
>	0x100 - 0x17F - Physical Unclonable Function(PUF)
>                efuses repurposed as user efuses
>
>Signed-off-by: Praveen Teja Kundanala <praveen.teja.kundanala@xxxxxxx>
>---
> drivers/nvmem/zynqmp_nvmem.c | 186
>+++++++++++++++++++++++++++++++++--
> 1 file changed, 176 insertions(+), 10 deletions(-)
>
>diff --git a/drivers/nvmem/zynqmp_nvmem.c
>b/drivers/nvmem/zynqmp_nvmem.c index 391d8e88b270..8682adaacd69
>100644
>--- a/drivers/nvmem/zynqmp_nvmem.c
>+++ b/drivers/nvmem/zynqmp_nvmem.c
>@@ -4,6 +4,7 @@
>  * Copyright (C) 2022 - 2023, Advanced Micro Devices, Inc.
>  */
>
>+#include <linux/dma-mapping.h>
> #include <linux/module.h>
> #include <linux/nvmem-provider.h>
> #include <linux/of.h>
>@@ -11,24 +12,189 @@
> #include <linux/firmware/xlnx-zynqmp.h>
>
> #define SILICON_REVISION_MASK 0xF
>+#define P_USER_0_64_UPPER_MASK	GENMASK(31, 16)
>+#define P_USER_127_LOWER_4_BIT_MASK GENMASK(3, 0)
>+#define WORD_INBYTES		4
>+#define SOC_VER_SIZE		0x4
>+#define EFUSE_MEMORY_SIZE	0x177
>+#define UNUSED_SPACE		0x8
>+#define ZYNQMP_NVMEM_SIZE	(SOC_VER_SIZE + UNUSED_SPACE + \
>+				 EFUSE_MEMORY_SIZE)
>+#define SOC_VERSION_OFFSET	0x0
>+#define EFUSE_START_OFFSET	0xC
>+#define EFUSE_END_OFFSET	0xFC
>+#define EFUSE_PUF_START_OFFSET	0x100
>+#define EFUSE_PUF_MID_OFFSET	0x140
>+#define EFUSE_PUF_END_OFFSET	0x17F
>+#define EFUSE_NOT_ENABLED	29
>
>+/*
>+ * efuse access type
>+ */
>+enum efuse_access {
>+	EFUSE_READ = 0,
>+	EFUSE_WRITE
>+};
>+
>+/**
>+ * struct xilinx_efuse - the basic structure
>+ * @src:	address of the buffer to store the data to be write/read
>+ * @size:	read/write word count
>+ * @offset:	read/write offset
>+ * @flag:	0 - represents efuse read and 1- represents efuse write
>+ * @pufuserfuse:0 - represents non-puf efuses, offset is used for read/write
>+ *		1 - represents puf user fuse row number.
>+ *
>+ * this structure stores all the required details to
>+ * read/write efuse memory.
>+ */
>+struct xilinx_efuse {
>+	u64 src;
>+	u32 size;
>+	u32 offset;
>+	enum efuse_access flag;
>+	u32 pufuserfuse;
>+};
>+
>+static int zynqmp_efuse_access(void *context, unsigned int offset,
>+			       void *val, size_t bytes, enum efuse_access flag,
>+			       unsigned int pufflag)
>+{
>+	struct device *dev = context;
>+	struct xilinx_efuse *efuse;
>+	dma_addr_t dma_addr;
>+	dma_addr_t dma_buf;
>+	size_t words = bytes / WORD_INBYTES;
>+	int ret;
>+	int value;
>+	char *data;
>+
>+	if (bytes % WORD_INBYTES != 0) {
>+		dev_err(dev, "Bytes requested should be word aligned\n");
>+		return -EOPNOTSUPP;
>+	}
>+
>+	if (pufflag == 0 && offset % WORD_INBYTES) {
>+		dev_err(dev, "Offset requested should be word aligned\n");
>+		return -EOPNOTSUPP;
>+	}
>+
>+	if (pufflag == 1 && flag == EFUSE_WRITE) {
>+		memcpy(&value, val, bytes);
>+		if ((offset == EFUSE_PUF_START_OFFSET ||
>+		     offset == EFUSE_PUF_MID_OFFSET) &&
>+		    value & P_USER_0_64_UPPER_MASK) {
>+			dev_err(dev, "Only lower 4 bytes are allowed to be
>programmed in P_USER_0 & P_USER_64\n");
>+			return -EOPNOTSUPP;
>+		}
>+
>+		if (offset == EFUSE_PUF_END_OFFSET &&
>+		    (value & P_USER_127_LOWER_4_BIT_MASK)) {
>+			dev_err(dev, "Only MSB 28 bits are allowed to be
>programmed for P_USER_127\n");
>+			return -EOPNOTSUPP;
>+		}
>+	}
>+
>+	efuse = dma_alloc_coherent(dev, sizeof(struct xilinx_efuse),
>+				   &dma_addr, GFP_KERNEL);
>+	if (!efuse)
>+		return -ENOMEM;
>
>-static int zynqmp_nvmem_read(void *context, unsigned int offset,
>-			     void *val, size_t bytes)
>+	data = dma_alloc_coherent(dev, sizeof(bytes),
>+				  &dma_buf, GFP_KERNEL);
>+	if (!data) {
>+		ret = -ENOMEM;
>+		goto efuse_data_fail;
>+	}
>+
>+	if (flag == EFUSE_WRITE) {
>+		memcpy(data, val, bytes);
>+		efuse->flag = EFUSE_WRITE;
>+	} else {
>+		efuse->flag = EFUSE_READ;
>+	}
>+
>+	efuse->src = dma_buf;
>+	efuse->size = words;
>+	efuse->offset = offset;
>+	efuse->pufuserfuse = pufflag;
>+
>+	zynqmp_pm_efuse_access(dma_addr, (u32 *)&ret);
>+	if (ret != 0) {
>+		if (ret == EFUSE_NOT_ENABLED) {
>+			dev_err(dev, "efuse access is not enabled\n");
>+			ret = -EOPNOTSUPP;
>+		} else {
>+			dev_err(dev, "Error in efuse read %x\n", ret);
>+			ret = -EPERM;
>+		}
>+		goto efuse_access_err;
>+	}
>+
>+	if (flag == EFUSE_READ)
>+		memcpy(val, data, bytes);
>+efuse_access_err:
>+	dma_free_coherent(dev, sizeof(bytes),
>+			  data, dma_buf);
>+efuse_data_fail:
>+	dma_free_coherent(dev, sizeof(struct xilinx_efuse),
>+			  efuse, dma_addr);
>+
>+	return ret;
>+}
>+
>+static int zynqmp_nvmem_read(void *context, unsigned int offset, void
>+*val, size_t bytes)
> {
> 	struct device *dev = context;
> 	int ret;
>+	int pufflag = 0;
> 	int idcode;
> 	int version;
>
>-	ret = zynqmp_pm_get_chipid(&idcode, &version);
>-	if (ret < 0)
>-		return ret;
>+	if (offset >= EFUSE_PUF_START_OFFSET && offset <=
>EFUSE_PUF_END_OFFSET)
>+		pufflag = 1;
>+
>+	switch (offset) {
>+	/* Soc version offset is zero */
>+	case SOC_VERSION_OFFSET:
>+		if (bytes != SOC_VER_SIZE)
>+			return -EOPNOTSUPP;
>+
>+		ret = zynqmp_pm_get_chipid((u32 *)&idcode, (u32
>*)&version);
>+		if (ret < 0)
>+			return ret;
>+
>+		dev_dbg(dev, "Read chipid val %x %x\n", idcode, version);
>+		*(int *)val = version & SILICON_REVISION_MASK;
>+		break;
>+	/* Efuse offset starts from 0xc */
>+	case EFUSE_START_OFFSET ... EFUSE_END_OFFSET:
>+	case EFUSE_PUF_START_OFFSET ... EFUSE_PUF_END_OFFSET:
>+		ret = zynqmp_efuse_access(context, offset, val,
>+					  bytes, EFUSE_READ, pufflag);
>+		break;
>+	default:
>+		*(u32 *)val = 0xDEADBEEF;
>+		ret = 0;
>+		break;
>+	}
>+
>+	return ret;
>+}
>+
>+static int zynqmp_nvmem_write(void *context,
>+			      unsigned int offset, void *val, size_t bytes) {
>+	int pufflag = 0;
>+
>+	if (offset < EFUSE_START_OFFSET || offset > EFUSE_PUF_END_OFFSET)
>+		return -EOPNOTSUPP;
>
>-	dev_dbg(dev, "Read chipid val %x %x\n", idcode, version);
>-	*(int *)val = version & SILICON_REVISION_MASK;
>+	if (offset >= EFUSE_PUF_START_OFFSET && offset <=
>EFUSE_PUF_END_OFFSET)
>+		pufflag = 1;
>
>-	return 0;
>+	return zynqmp_efuse_access(context, offset,
>+				   val, bytes, EFUSE_WRITE, pufflag);
> }
>
> static const struct of_device_id zynqmp_nvmem_match[] = { @@ -45,11
>+211,11 @@ static int zynqmp_nvmem_probe(struct platform_device *pdev)
> 	econfig.name = "zynqmp-nvmem";
> 	econfig.owner = THIS_MODULE;
> 	econfig.word_size = 1;
>-	econfig.size = 1;
>+	econfig.size = ZYNQMP_NVMEM_SIZE;
> 	econfig.dev = dev;
> 	econfig.add_legacy_fixed_of_cells = true;
>-	econfig.read_only = true;
> 	econfig.reg_read = zynqmp_nvmem_read;
>+	econfig.reg_write = zynqmp_nvmem_write;
>
> 	return PTR_ERR_OR_ZERO(devm_nvmem_register(dev, &econfig));  }
>--
>2.37.6

Acked-by: Kalyani Akula <Kalyani.akula@xxxxxxx>
 
Regards,
Kalyani

<<attachment: winmail.dat>>


[Index of Archives]     [Device Tree Compilter]     [Device Tree Spec]     [Linux Driver Backports]     [Video for Linux]     [Linux USB Devel]     [Linux PCI Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Yosemite Backpacking]


  Powered by Linux