[][mtd: mtk-snand: set NFI_CNFG as default after finishing read_cache & program_load]

[Description]
Fix write error with setting NFI_CNFG as default after
finishing read_cache & program_load operations.

[Release-log]
N/A

Change-Id: Iead65bbe75a12b066cb01706b0a654ec83666b04
Reviewed-on: https://gerrit.mediatek.inc/c/openwrt/feeds/mtk_openwrt_feeds/+/4551099
diff --git a/target/linux/mediatek/files-5.4/drivers/mtd/mtk-snand/mtk-snand.c b/target/linux/mediatek/files-5.4/drivers/mtd/mtk-snand/mtk-snand.c
index f305bcb..0dacf4f 100644
--- a/target/linux/mediatek/files-5.4/drivers/mtd/mtk-snand/mtk-snand.c
+++ b/target/linux/mediatek/files-5.4/drivers/mtd/mtk-snand/mtk-snand.c
@@ -800,6 +800,7 @@
 
 	/* Stop read */
 	nfi_write32(snf, NFI_CON, 0);
+	nfi_write16(snf, NFI_CNFG, 0);
 
 	/* Clear SNF done flag */
 	nfi_rmw32(snf, SNF_STA_CTL1, 0, CUS_READ_DONE);
@@ -1016,7 +1017,8 @@
 	dma_mem_unmap(snf->pdev, dma_addr, len, true);
 
 	/* Stop write */
-	nfi_write16(snf, NFI_CON, 0);
+	nfi_write32(snf, NFI_CON, 0);
+	nfi_write16(snf, NFI_CNFG, 0);
 
 	/* Clear SNF done flag */
 	nfi_rmw32(snf, SNF_STA_CTL1, 0, CUS_PG_DONE);