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>
This commit is contained in:
parent
b0760df876
commit
fd7b518283
|
|
@ -97,6 +97,57 @@ read_end:
|
||||||
return ret;
|
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)
|
static int rockchip_rv1126_otp_init(struct udevice *dev)
|
||||||
{
|
{
|
||||||
struct rockchip_otp_platdata *otp = dev_get_platdata(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,
|
.read = rockchip_px30_otp_read,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static const struct otp_data rk3568_data = {
|
||||||
|
.read = rockchip_rk3568_otp_read,
|
||||||
|
};
|
||||||
|
|
||||||
static const struct otp_data rv1126_data = {
|
static const struct otp_data rv1126_data = {
|
||||||
.init = rockchip_rv1126_otp_init,
|
.init = rockchip_rv1126_otp_init,
|
||||||
.read = rockchip_rv1126_otp_read,
|
.read = rockchip_rv1126_otp_read,
|
||||||
|
|
@ -203,6 +258,10 @@ static const struct udevice_id rockchip_otp_ids[] = {
|
||||||
.compatible = "rockchip,rk3308-otp",
|
.compatible = "rockchip,rk3308-otp",
|
||||||
.data = (ulong)&px30_data,
|
.data = (ulong)&px30_data,
|
||||||
},
|
},
|
||||||
|
{
|
||||||
|
.compatible = "rockchip,rk3568-otp",
|
||||||
|
.data = (ulong)&rk3568_data,
|
||||||
|
},
|
||||||
{
|
{
|
||||||
.compatible = "rockchip,rv1126-otp",
|
.compatible = "rockchip,rv1126-otp",
|
||||||
.data = (ulong)&rv1126_data,
|
.data = (ulong)&rv1126_data,
|
||||||
|
|
|
||||||
|
|
@ -42,6 +42,8 @@
|
||||||
|
|
||||||
#define OTPC_TIMEOUT 10000
|
#define OTPC_TIMEOUT 10000
|
||||||
|
|
||||||
|
#define RK3568_NBYTES 2
|
||||||
|
|
||||||
#define RV1126_OTP_NVM_CEB 0x00
|
#define RV1126_OTP_NVM_CEB 0x00
|
||||||
#define RV1126_OTP_NVM_RSTB 0x04
|
#define RV1126_OTP_NVM_RSTB 0x04
|
||||||
#define RV1126_OTP_NVM_ST 0x18
|
#define RV1126_OTP_NVM_ST 0x18
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue