Two helpers have been added to the core to make ECC-related
configuration between the detection phase and the final NAND scan. Use
these hooks and convert the driver to just use nand_scan() instead of
both nand_scan_ident() and nand_scan_tail().

Signed-off-by: Miquel Raynal <miquel.ray...@bootlin.com>
---
 drivers/mtd/nand/raw/mtk_nand.c | 75 ++++++++++++++++++++++++-----------------
 1 file changed, 44 insertions(+), 31 deletions(-)

diff --git a/drivers/mtd/nand/raw/mtk_nand.c b/drivers/mtd/nand/raw/mtk_nand.c
index 7bc6be3f6ec0..967418f945ea 100644
--- a/drivers/mtd/nand/raw/mtk_nand.c
+++ b/drivers/mtd/nand/raw/mtk_nand.c
@@ -1250,13 +1250,54 @@ static int mtk_nfc_ecc_init(struct device *dev, struct 
mtd_info *mtd)
        return 0;
 }
 
+static int mtk_nfc_attach_chip(struct nand_chip *chip)
+{
+       struct mtd_info *mtd = nand_to_mtd(chip);
+       struct device *dev = mtd->dev.parent;
+       struct mtk_nfc *nfc = nand_get_controller_data(chip);
+       struct mtk_nfc_nand_chip *mtk_nand = to_mtk_nand(chip);
+       int len;
+       int ret;
+
+       if (chip->options & NAND_BUSWIDTH_16) {
+               dev_err(dev, "16bits buswidth not supported");
+               return -EINVAL;
+       }
+
+       /* store bbt magic in page, cause OOB is not protected */
+       if (chip->bbt_options & NAND_BBT_USE_FLASH)
+               chip->bbt_options |= NAND_BBT_NO_OOB;
+
+       ret = mtk_nfc_ecc_init(dev, mtd);
+       if (ret)
+               return ret;
+
+       ret = mtk_nfc_set_spare_per_sector(&mtk_nand->spare_per_sector, mtd);
+       if (ret)
+               return ret;
+
+       mtk_nfc_set_fdm(&mtk_nand->fdm, mtd);
+       mtk_nfc_set_bad_mark_ctl(&mtk_nand->bad_mark, mtd);
+
+       len = mtd->writesize + mtd->oobsize;
+       nfc->buffer = devm_kzalloc(dev, len, GFP_KERNEL);
+       if (!nfc->buffer)
+               return  -ENOMEM;
+
+       return 0;
+}
+
+static const struct nand_controller_ops mtk_nfc_controller_ops = {
+       .attach_chip = mtk_nfc_attach_chip,
+};
+
 static int mtk_nfc_nand_chip_init(struct device *dev, struct mtk_nfc *nfc,
                                  struct device_node *np)
 {
        struct mtk_nfc_nand_chip *chip;
        struct nand_chip *nand;
        struct mtd_info *mtd;
-       int nsels, len;
+       int nsels;
        u32 tmp;
        int ret;
        int i;
@@ -1287,6 +1328,7 @@ static int mtk_nfc_nand_chip_init(struct device *dev, 
struct mtk_nfc *nfc,
 
        nand = &chip->nand;
        nand->controller = &nfc->controller;
+       nand->controller->ops = &mtk_nfc_controller_ops;
 
        nand_set_flash_node(nand, np);
        nand_set_controller_data(nand, nfc);
@@ -1324,36 +1366,7 @@ static int mtk_nfc_nand_chip_init(struct device *dev, 
struct mtk_nfc *nfc,
 
        mtk_nfc_hw_init(nfc);
 
-       ret = nand_scan_ident(mtd, nsels, NULL);
-       if (ret)
-               return ret;
-
-       /* store bbt magic in page, cause OOB is not protected */
-       if (nand->bbt_options & NAND_BBT_USE_FLASH)
-               nand->bbt_options |= NAND_BBT_NO_OOB;
-
-       ret = mtk_nfc_ecc_init(dev, mtd);
-       if (ret)
-               return -EINVAL;
-
-       if (nand->options & NAND_BUSWIDTH_16) {
-               dev_err(dev, "16bits buswidth not supported");
-               return -EINVAL;
-       }
-
-       ret = mtk_nfc_set_spare_per_sector(&chip->spare_per_sector, mtd);
-       if (ret)
-               return ret;
-
-       mtk_nfc_set_fdm(&chip->fdm, mtd);
-       mtk_nfc_set_bad_mark_ctl(&chip->bad_mark, mtd);
-
-       len = mtd->writesize + mtd->oobsize;
-       nfc->buffer = devm_kzalloc(dev, len, GFP_KERNEL);
-       if (!nfc->buffer)
-               return  -ENOMEM;
-
-       ret = nand_scan_tail(mtd);
+       ret = nand_scan(mtd, nsels);
        if (ret)
                return ret;
 
-- 
2.14.1

Reply via email to