Commit 885ce72a authored by Peng Fan's avatar Peng Fan Committed by Greg Kroah-Hartman

nvmem: imx: scu: support write

The fuse programming from non-secure world is blocked, so we could
only use Arm Trusted Firmware SIP call to let ATF program fuse.

Because there is ECC region that could only be programmed once,
so add a heler in_ecc to check the ecc region.
Signed-off-by: default avatarPeng Fan <peng.fan@nxp.com>
Signed-off-by: default avatarSrinivas Kandagatla <srinivas.kandagatla@linaro.org>
Link: https://lore.kernel.org/r/20191029114240.14905-5-srinivas.kandagatla@linaro.orgSigned-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent f8017bfc
...@@ -7,6 +7,7 @@ ...@@ -7,6 +7,7 @@
* Peng Fan <peng.fan@nxp.com> * Peng Fan <peng.fan@nxp.com>
*/ */
#include <linux/arm-smccc.h>
#include <linux/firmware/imx/sci.h> #include <linux/firmware/imx/sci.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/nvmem-provider.h> #include <linux/nvmem-provider.h>
...@@ -14,6 +15,9 @@ ...@@ -14,6 +15,9 @@
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/slab.h> #include <linux/slab.h>
#define IMX_SIP_OTP 0xC200000A
#define IMX_SIP_OTP_WRITE 0x2
enum ocotp_devtype { enum ocotp_devtype {
IMX8QXP, IMX8QXP,
IMX8QM, IMX8QM,
...@@ -46,6 +50,8 @@ struct imx_sc_msg_misc_fuse_read { ...@@ -46,6 +50,8 @@ struct imx_sc_msg_misc_fuse_read {
u32 word; u32 word;
} __packed; } __packed;
static DEFINE_MUTEX(scu_ocotp_mutex);
static struct ocotp_devtype_data imx8qxp_data = { static struct ocotp_devtype_data imx8qxp_data = {
.devtype = IMX8QXP, .devtype = IMX8QXP,
.nregs = 800, .nregs = 800,
...@@ -84,6 +90,23 @@ static bool in_hole(void *context, u32 index) ...@@ -84,6 +90,23 @@ static bool in_hole(void *context, u32 index)
return false; return false;
} }
static bool in_ecc(void *context, u32 index)
{
struct ocotp_priv *priv = context;
const struct ocotp_devtype_data *data = priv->data;
int i;
for (i = 0; i < data->num_region; i++) {
if (data->region[i].flag & ECC_REGION) {
if ((index >= data->region[i].start) &&
(index <= data->region[i].end))
return true;
}
}
return false;
}
static int imx_sc_misc_otp_fuse_read(struct imx_sc_ipc *ipc, u32 word, static int imx_sc_misc_otp_fuse_read(struct imx_sc_ipc *ipc, u32 word,
u32 *val) u32 *val)
{ {
...@@ -127,6 +150,8 @@ static int imx_scu_ocotp_read(void *context, unsigned int offset, ...@@ -127,6 +150,8 @@ static int imx_scu_ocotp_read(void *context, unsigned int offset,
if (!p) if (!p)
return -ENOMEM; return -ENOMEM;
mutex_lock(&scu_ocotp_mutex);
buf = p; buf = p;
for (i = index; i < (index + count); i++) { for (i = index; i < (index + count); i++) {
...@@ -137,6 +162,7 @@ static int imx_scu_ocotp_read(void *context, unsigned int offset, ...@@ -137,6 +162,7 @@ static int imx_scu_ocotp_read(void *context, unsigned int offset,
ret = imx_sc_misc_otp_fuse_read(priv->nvmem_ipc, i, buf); ret = imx_sc_misc_otp_fuse_read(priv->nvmem_ipc, i, buf);
if (ret) { if (ret) {
mutex_unlock(&scu_ocotp_mutex);
kfree(p); kfree(p);
return ret; return ret;
} }
...@@ -145,18 +171,63 @@ static int imx_scu_ocotp_read(void *context, unsigned int offset, ...@@ -145,18 +171,63 @@ static int imx_scu_ocotp_read(void *context, unsigned int offset,
memcpy(val, (u8 *)p + offset % 4, bytes); memcpy(val, (u8 *)p + offset % 4, bytes);
mutex_unlock(&scu_ocotp_mutex);
kfree(p); kfree(p);
return 0; return 0;
} }
static int imx_scu_ocotp_write(void *context, unsigned int offset,
void *val, size_t bytes)
{
struct ocotp_priv *priv = context;
struct arm_smccc_res res;
u32 *buf = val;
u32 tmp;
u32 index;
int ret;
/* allow only writing one complete OTP word at a time */
if ((bytes != 4) || (offset % 4))
return -EINVAL;
index = offset >> 2;
if (in_hole(context, index))
return -EINVAL;
if (in_ecc(context, index)) {
pr_warn("ECC region, only program once\n");
mutex_lock(&scu_ocotp_mutex);
ret = imx_sc_misc_otp_fuse_read(priv->nvmem_ipc, index, &tmp);
mutex_unlock(&scu_ocotp_mutex);
if (ret)
return ret;
if (tmp) {
pr_warn("ECC region, already has value: %x\n", tmp);
return -EIO;
}
}
mutex_lock(&scu_ocotp_mutex);
arm_smccc_smc(IMX_SIP_OTP, IMX_SIP_OTP_WRITE, index, *buf,
0, 0, 0, 0, &res);
mutex_unlock(&scu_ocotp_mutex);
return res.a0;
}
static struct nvmem_config imx_scu_ocotp_nvmem_config = { static struct nvmem_config imx_scu_ocotp_nvmem_config = {
.name = "imx-scu-ocotp", .name = "imx-scu-ocotp",
.read_only = true, .read_only = false,
.word_size = 4, .word_size = 4,
.stride = 1, .stride = 1,
.owner = THIS_MODULE, .owner = THIS_MODULE,
.reg_read = imx_scu_ocotp_read, .reg_read = imx_scu_ocotp_read,
.reg_write = imx_scu_ocotp_write,
}; };
static const struct of_device_id imx_scu_ocotp_dt_ids[] = { static const struct of_device_id imx_scu_ocotp_dt_ids[] = {
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment