modify for bch

Author: rogeryou

storage/blockdevice/COMPONENT_SPINAND/source/SPINANDBlockDevice.cpp

@@ -707,6 +707,12 @@ bool SPINANDBlockDevice::_read_otp_onfi()
         _ecc_bits = onfi_table[112];
         if (_ecc_bits > 0) {
             _bch_init(_ecc_bits);
+            secur_reg &= ~SPINAND_SECURE_BIT_ECC_EN;
+
+            if (QSPI_STATUS_OK != _qspi_send_general_command(SPINAND_INST_SET_FEATURE, FEATURES_ADDR_SECURE_OTP,
+                                                             (char *) &secur_reg, 1, NULL, 0)) {
+                tr_error("Writing Register failed");
+            }
         } else {
             secur_reg |= SPINAND_SECURE_BIT_ECC_EN;
 

storage/blockdevice/COMPONENT_SPINAND/source/bch.c

@@ -267,20 +267,22 @@ void encode_bch(struct bch_control *bch, const uint8_t *data,
 
         for (i = 0; i < l; i++) {
             r[i] = r[i + 1] ^ p0[i] ^ p1[i] ^ p2[i] ^ p3[i];
-            r[l] = p0[l] ^ p1[l] ^ p2[l] ^ p3[l];
+            
         }
-        memcpy(bch->ecc_buf, r, sizeof(r));
+        r[l] = p0[l] ^ p1[l] ^ p2[l] ^ p3[l];
+    }
+    memcpy(bch->ecc_buf, r, sizeof(r));
 
-        /* process last unaligned bytes */
-        if (len) {
-            encode_bch_unaligned(bch, data, len, bch->ecc_buf);
-        }
+    /* process last unaligned bytes */
+    if (len) {
+        encode_bch_unaligned(bch, data, len, bch->ecc_buf);
+    }
 
-        /* store ecc parity bytes into original parity buffer */
-        if (ecc) {
-            store_ecc8(bch, ecc, bch->ecc_buf);
-        }
+    /* store ecc parity bytes into original parity buffer */
+    if (ecc) {
+        store_ecc8(bch, ecc, bch->ecc_buf);
     }
+
 }
 
 static inline int modulo(struct bch_control *bch, unsigned int v)

targets/targets.json

@@ -4403,7 +4403,7 @@
             "STM32L4R9xI"
         ],
         "components_add": [
-            "FLASHIAP"
+
         ],
         "macros_add": [
             "STM32L4R9xx"
@@ -4423,7 +4423,7 @@
             "MX25LM51245G"
         ],
         "components_add": [
-            "OSPIF"
+            "SPINAND"
         ],
         "macros_add": [
             "HSE_VALUE=16000000"