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);