From fd7b5182835a7c6a57411514986dc70498efef52 Mon Sep 17 00:00:00 2001
From: Finley Xiao <finley.xiao@rock-chips.com>
Date: Mon, 7 Dec 2020 15:11:02 +0800
Subject: [PATCH] rockchip: otp: Add support for rk3568

This adds the necessary data for handling otp on the rk3568.

Change-Id: Id5e8a3a1561604bb307ef17e06d11d7e62d8a840
Signed-off-by: Finley Xiao <finley.xiao@rock-chips.com>
---
 drivers/misc/rockchip-otp.c | 59 +++++++++++++++++++++++++++++++++++++
 include/rockchip-otp.h      |  2 ++
 2 files changed, 61 insertions(+)

diff --git a/drivers/misc/rockchip-otp.c b/drivers/misc/rockchip-otp.c
index f3b6c69bbf..84aecd14d6 100644
--- a/drivers/misc/rockchip-otp.c
+++ b/drivers/misc/rockchip-otp.c
@@ -97,6 +97,57 @@ read_end:
 	return ret;
 }
 
+static int rockchip_rk3568_otp_read(struct udevice *dev, int offset, void *buf,
+				    int size)
+{
+	struct rockchip_otp_platdata *otp = dev_get_platdata(dev);
+	unsigned int addr_start, addr_end, addr_offset, addr_len;
+	u32 out_value;
+	u8 *buffer;
+	int ret = 0, i = 0;
+
+	addr_start = rounddown(offset, RK3568_NBYTES) / RK3568_NBYTES;
+	addr_end = roundup(offset + size, RK3568_NBYTES) / RK3568_NBYTES;
+	addr_offset = offset % RK3568_NBYTES;
+	addr_len = addr_end - addr_start;
+
+	buffer = calloc(1, sizeof(*buffer) * addr_len * RK3568_NBYTES);
+	if (!buffer)
+		return -ENOMEM;
+
+	ret = rockchip_otp_ecc_enable(otp, false);
+	if (ret < 0) {
+		printf("%s rockchip_otp_ecc_enable err\n", __func__);
+		return ret;
+	}
+
+	writel(OTPC_USE_USER | OTPC_USE_USER_MASK, otp->base + OTPC_USER_CTRL);
+	udelay(5);
+	while (addr_len--) {
+		writel(addr_start++ | OTPC_USER_ADDR_MASK,
+		       otp->base + OTPC_USER_ADDR);
+		writel(OTPC_USER_FSM_ENABLE | OTPC_USER_FSM_ENABLE_MASK,
+		       otp->base + OTPC_USER_ENABLE);
+		ret = rockchip_otp_wait_status(otp, OTPC_USER_DONE);
+		if (ret < 0) {
+			printf("%s timeout during read setup\n", __func__);
+			goto read_end;
+		}
+		out_value = readl(otp->base + OTPC_USER_Q);
+		memcpy(&buffer[i], &out_value, RK3568_NBYTES);
+		i += RK3568_NBYTES;
+	}
+
+	memcpy(buf, buffer + addr_offset, size);
+
+read_end:
+	writel(0x0 | OTPC_USE_USER_MASK, otp->base + OTPC_USER_CTRL);
+
+	kfree(buffer);
+
+	return ret;
+}
+
 static int rockchip_rv1126_otp_init(struct udevice *dev)
 {
 	struct rockchip_otp_platdata *otp = dev_get_platdata(dev);
@@ -189,6 +240,10 @@ static const struct otp_data px30_data = {
 	.read = rockchip_px30_otp_read,
 };
 
+static const struct otp_data rk3568_data = {
+	.read = rockchip_rk3568_otp_read,
+};
+
 static const struct otp_data rv1126_data = {
 	.init = rockchip_rv1126_otp_init,
 	.read = rockchip_rv1126_otp_read,
@@ -203,6 +258,10 @@ static const struct udevice_id rockchip_otp_ids[] = {
 		.compatible = "rockchip,rk3308-otp",
 		.data = (ulong)&px30_data,
 	},
+	{
+		.compatible = "rockchip,rk3568-otp",
+		.data = (ulong)&rk3568_data,
+	},
 	{
 		.compatible = "rockchip,rv1126-otp",
 		.data = (ulong)&rv1126_data,
diff --git a/include/rockchip-otp.h b/include/rockchip-otp.h
index bd9915a8f1..176b207d5e 100644
--- a/include/rockchip-otp.h
+++ b/include/rockchip-otp.h
@@ -42,6 +42,8 @@
 
 #define OTPC_TIMEOUT			10000
 
+#define RK3568_NBYTES			2
+
 #define RV1126_OTP_NVM_CEB		0x00
 #define RV1126_OTP_NVM_RSTB		0x04
 #define RV1126_OTP_NVM_ST		0x18