arm: mxs: ocotp: disable OCOTP clock after access is finished

[karo-tx-uboot.git] / drivers / misc / mxc_ocotp.c

diff --git a/drivers/misc/mxc_ocotp.c b/drivers/misc/mxc_ocotp.c
index d92044eeda227a7eba57bdb6b8a7b72ce1fdf80f..4f222e6f991a28bf5418ba42e165eb67ee22ebd1 100644 (file)
--- a/drivers/misc/mxc_ocotp.c
+++ b/drivers/misc/mxc_ocotp.c
@@ -60,7 +60,7 @@ static int prepare_access(struct ocotp_regs **regs, u32 bank, u32 word,
        *regs = (struct ocotp_regs *)OCOTP_BASE_ADDR;
 
        if (bank >= ARRAY_SIZE((*regs)->bank) ||
-                       word >= ARRAY_SIZE((*regs)->bank[0].fuse_regs) >> 2 ||
+                       word >= ARRAY_SIZE((*regs)->bank[0].fuse_regs) ||
                        !assert) {
                printf("mxc_ocotp %s(): Invalid argument\n", caller);
                return -EINVAL;
@@ -80,6 +80,7 @@ static int finish_access(struct ocotp_regs *regs, const char *caller)
 
        err = !!(readl(&regs->ctrl) & BM_CTRL_ERROR);
        clear_error(regs);
+       enable_ocotp_clk(0);
 
        if (err) {
                printf("mxc_ocotp %s(): Access protect error\n", caller);