OSDN Git Service

mtd: rawnand: tegra: convert driver to nand_scan()
authorMiquel Raynal <miquel.raynal@bootlin.com>
Wed, 25 Jul 2018 13:31:47 +0000 (15:31 +0200)
committerMiquel Raynal <miquel.raynal@bootlin.com>
Tue, 31 Jul 2018 07:46:12 +0000 (09:46 +0200)
Two helpers have been added to the core to do all kind of controller
side configuration/initialization between the detection phase and the
final NAND scan. Implement these hooks so that we can convert the driver
to just use nand_scan() instead of the nand_scan_ident() +
nand_scan_tail() pair.

Signed-off-by: Miquel Raynal <miquel.raynal@bootlin.com>
Reviewed-by: Boris Brezillon <boris.brezillon@bootlin.com>
drivers/mtd/nand/raw/tegra_nand.c

index 31c0d9c..79da1ef 100644 (file)
@@ -906,74 +906,13 @@ static int tegra_nand_select_strength(struct nand_chip *chip, int oobsize)
                                       bits_per_step, oobsize);
 }
 
-static int tegra_nand_chips_init(struct device *dev,
-                                struct tegra_nand_controller *ctrl)
+static int tegra_nand_attach_chip(struct nand_chip *chip)
 {
-       struct device_node *np = dev->of_node;
-       struct device_node *np_nand;
-       int nsels, nchips = of_get_child_count(np);
-       struct tegra_nand_chip *nand;
-       struct mtd_info *mtd;
-       struct nand_chip *chip;
+       struct tegra_nand_controller *ctrl = to_tegra_ctrl(chip->controller);
+       struct tegra_nand_chip *nand = to_tegra_chip(chip);
+       struct mtd_info *mtd = nand_to_mtd(chip);
        int bits_per_step;
        int ret;
-       u32 cs;
-
-       if (nchips != 1) {
-               dev_err(dev, "Currently only one NAND chip supported\n");
-               return -EINVAL;
-       }
-
-       np_nand = of_get_next_child(np, NULL);
-
-       nsels = of_property_count_elems_of_size(np_nand, "reg", sizeof(u32));
-       if (nsels != 1) {
-               dev_err(dev, "Missing/invalid reg property\n");
-               return -EINVAL;
-       }
-
-       /* Retrieve CS id, currently only single die NAND supported */
-       ret = of_property_read_u32(np_nand, "reg", &cs);
-       if (ret) {
-               dev_err(dev, "could not retrieve reg property: %d\n", ret);
-               return ret;
-       }
-
-       nand = devm_kzalloc(dev, sizeof(*nand), GFP_KERNEL);
-       if (!nand)
-               return -ENOMEM;
-
-       nand->cs[0] = cs;
-
-       nand->wp_gpio = devm_gpiod_get_optional(dev, "wp", GPIOD_OUT_LOW);
-
-       if (IS_ERR(nand->wp_gpio)) {
-               ret = PTR_ERR(nand->wp_gpio);
-               dev_err(dev, "Failed to request WP GPIO: %d\n", ret);
-               return ret;
-       }
-
-       chip = &nand->chip;
-       chip->controller = &ctrl->controller;
-
-       mtd = nand_to_mtd(chip);
-
-       mtd->dev.parent = dev;
-       mtd->owner = THIS_MODULE;
-
-       nand_set_flash_node(chip, np_nand);
-
-       if (!mtd->name)
-               mtd->name = "tegra_nand";
-
-       chip->options = NAND_NO_SUBPAGE_WRITE | NAND_USE_BOUNCE_BUFFER;
-       chip->exec_op = tegra_nand_exec_op;
-       chip->select_chip = tegra_nand_select_chip;
-       chip->setup_data_interface = tegra_nand_setup_data_interface;
-
-       ret = nand_scan_ident(mtd, 1, NULL);
-       if (ret)
-               return ret;
 
        if (chip->bbt_options & NAND_BBT_USE_FLASH)
                chip->bbt_options |= NAND_BBT_NO_OOB;
@@ -982,7 +921,8 @@ static int tegra_nand_chips_init(struct device *dev,
        chip->ecc.size = 512;
        chip->ecc.steps = mtd->writesize / chip->ecc.size;
        if (chip->ecc_step_ds != 512) {
-               dev_err(dev, "Unsupported step size %d\n", chip->ecc_step_ds);
+               dev_err(ctrl->dev, "Unsupported step size %d\n",
+                       chip->ecc_step_ds);
                return -EINVAL;
        }
 
@@ -1004,14 +944,15 @@ static int tegra_nand_chips_init(struct device *dev,
        }
 
        if (chip->ecc.algo == NAND_ECC_BCH && mtd->writesize < 2048) {
-               dev_err(dev, "BCH supports 2K or 4K page size only\n");
+               dev_err(ctrl->dev, "BCH supports 2K or 4K page size only\n");
                return -EINVAL;
        }
 
        if (!chip->ecc.strength) {
                ret = tegra_nand_select_strength(chip, mtd->oobsize);
                if (ret < 0) {
-                       dev_err(dev, "No valid strength found, minimum %d\n",
+                       dev_err(ctrl->dev,
+                               "No valid strength found, minimum %d\n",
                                chip->ecc_strength_ds);
                        return ret;
                }
@@ -1039,7 +980,7 @@ static int tegra_nand_chips_init(struct device *dev,
                        nand->config_ecc |= CONFIG_TVAL_8;
                        break;
                default:
-                       dev_err(dev, "ECC strength %d not supported\n",
+                       dev_err(ctrl->dev, "ECC strength %d not supported\n",
                                chip->ecc.strength);
                        return -EINVAL;
                }
@@ -1062,17 +1003,17 @@ static int tegra_nand_chips_init(struct device *dev,
                        nand->bch_config |= BCH_TVAL_16;
                        break;
                default:
-                       dev_err(dev, "ECC strength %d not supported\n",
+                       dev_err(ctrl->dev, "ECC strength %d not supported\n",
                                chip->ecc.strength);
                        return -EINVAL;
                }
                break;
        default:
-               dev_err(dev, "ECC algorithm not supported\n");
+               dev_err(ctrl->dev, "ECC algorithm not supported\n");
                return -EINVAL;
        }
 
-       dev_info(dev, "Using %s with strength %d per 512 byte step\n",
+       dev_info(ctrl->dev, "Using %s with strength %d per 512 byte step\n",
                 chip->ecc.algo == NAND_ECC_BCH ? "BCH" : "RS",
                 chip->ecc.strength);
 
@@ -1095,7 +1036,8 @@ static int tegra_nand_chips_init(struct device *dev,
                nand->config |= CONFIG_PS_4096;
                break;
        default:
-               dev_err(dev, "Unsupported writesize %d\n", mtd->writesize);
+               dev_err(ctrl->dev, "Unsupported writesize %d\n",
+                       mtd->writesize);
                return -ENODEV;
        }
 
@@ -1106,7 +1048,78 @@ static int tegra_nand_chips_init(struct device *dev,
        nand->config |= CONFIG_TAG_BYTE_SIZE(mtd->oobsize - 1);
        writel_relaxed(nand->config, ctrl->regs + CONFIG);
 
-       ret = nand_scan_tail(mtd);
+       return 0;
+}
+
+static const struct nand_controller_ops tegra_nand_controller_ops = {
+       .attach_chip = &tegra_nand_attach_chip,
+};
+
+static int tegra_nand_chips_init(struct device *dev,
+                                struct tegra_nand_controller *ctrl)
+{
+       struct device_node *np = dev->of_node;
+       struct device_node *np_nand;
+       int nsels, nchips = of_get_child_count(np);
+       struct tegra_nand_chip *nand;
+       struct mtd_info *mtd;
+       struct nand_chip *chip;
+       int ret;
+       u32 cs;
+
+       if (nchips != 1) {
+               dev_err(dev, "Currently only one NAND chip supported\n");
+               return -EINVAL;
+       }
+
+       np_nand = of_get_next_child(np, NULL);
+
+       nsels = of_property_count_elems_of_size(np_nand, "reg", sizeof(u32));
+       if (nsels != 1) {
+               dev_err(dev, "Missing/invalid reg property\n");
+               return -EINVAL;
+       }
+
+       /* Retrieve CS id, currently only single die NAND supported */
+       ret = of_property_read_u32(np_nand, "reg", &cs);
+       if (ret) {
+               dev_err(dev, "could not retrieve reg property: %d\n", ret);
+               return ret;
+       }
+
+       nand = devm_kzalloc(dev, sizeof(*nand), GFP_KERNEL);
+       if (!nand)
+               return -ENOMEM;
+
+       nand->cs[0] = cs;
+
+       nand->wp_gpio = devm_gpiod_get_optional(dev, "wp", GPIOD_OUT_LOW);
+
+       if (IS_ERR(nand->wp_gpio)) {
+               ret = PTR_ERR(nand->wp_gpio);
+               dev_err(dev, "Failed to request WP GPIO: %d\n", ret);
+               return ret;
+       }
+
+       chip = &nand->chip;
+       chip->controller = &ctrl->controller;
+
+       mtd = nand_to_mtd(chip);
+
+       mtd->dev.parent = dev;
+       mtd->owner = THIS_MODULE;
+
+       nand_set_flash_node(chip, np_nand);
+
+       if (!mtd->name)
+               mtd->name = "tegra_nand";
+
+       chip->options = NAND_NO_SUBPAGE_WRITE | NAND_USE_BOUNCE_BUFFER;
+       chip->exec_op = tegra_nand_exec_op;
+       chip->select_chip = tegra_nand_select_chip;
+       chip->setup_data_interface = tegra_nand_setup_data_interface;
+
+       ret = nand_scan(mtd, 1);
        if (ret)
                return ret;
 
@@ -1137,6 +1150,7 @@ static int tegra_nand_probe(struct platform_device *pdev)
 
        ctrl->dev = &pdev->dev;
        nand_controller_init(&ctrl->controller);
+       ctrl->controller.ops = &tegra_nand_controller_ops;
 
        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
        ctrl->regs = devm_ioremap_resource(&pdev->dev, res);