misc: k3_fuse: Limit writes to 25bit values

K3 OTP bits can only be programmed 25bits at a time. Limit the value
accordingly using a 25 bit mask.

Signed-off-by: Vignesh Raghavendra <vigneshr@ti.com>
Signed-off-by: Anshul Dalal <anshuld@ti.com>

diff --git a/drivers/misc/k3_fuse.c b/drivers/misc/k3_fuse.c
index d738f75f2728ddb5e37837d88baded8f529c330e..faafaffe07ec2245b0bdb8fb69521f2db4297667 100644 (file)
--- a/drivers/misc/k3_fuse.c
+++ b/drivers/misc/k3_fuse.c
@@ -7,6 +7,7 @@
 #include <stdio.h>
 #include <fuse.h>
 #include <linux/arm-smccc.h>
+#include <linux/bitops.h>
 #include <string.h>
 
 #define K3_SIP_OTP_WRITEBUFF 0xC2000000
@@ -41,7 +42,6 @@ int fuse_sense(u32 bank, u32 word, u32 *val)
 int fuse_prog(u32 bank, u32 word, u32 val)
 {
        struct arm_smccc_res res;
-       u32 mask = val;
 
        if (bank != 0U) {
                printf("Invalid bank argument, ONLY bank 0 is supported\n");
@@ -49,8 +49,8 @@ int fuse_prog(u32 bank, u32 word, u32 val)
        }
 
        /* Make SiP SMC call and send the word, val and mask in the parameter register */
-       arm_smccc_smc(K3_SIP_OTP_WRITE, word,
-                     val, mask, 0, 0, 0, 0, &res);
+       arm_smccc_smc(K3_SIP_OTP_WRITE, bank, word,
+                     val, GENMASK(25, 0), 0, 0, 0, &res);
 
        if (res.a0 != 0) {
                printf("SMC call failed: Error code %ld\n", res.a0);