xref: /openbmc/linux/drivers/mtd/nand/raw/gpio.c (revision 1ac731c529cd4d6adbce134754b51ff7d822b145)
1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
293db446aSBoris Brezillon /*
393db446aSBoris Brezillon  * Updated, and converted to generic GPIO based driver by Russell King.
493db446aSBoris Brezillon  *
593db446aSBoris Brezillon  * Written by Ben Dooks <ben@simtec.co.uk>
693db446aSBoris Brezillon  *   Based on 2.4 version by Mark Whittaker
793db446aSBoris Brezillon  *
893db446aSBoris Brezillon  * © 2004 Simtec Electronics
993db446aSBoris Brezillon  *
1093db446aSBoris Brezillon  * Device driver for NAND flash that uses a memory mapped interface to
1193db446aSBoris Brezillon  * read/write the NAND commands and data, and GPIO pins for control signals
1293db446aSBoris Brezillon  * (the DT binding refers to this as "GPIO assisted NAND flash")
1393db446aSBoris Brezillon  */
1493db446aSBoris Brezillon 
1593db446aSBoris Brezillon #include <linux/kernel.h>
1693db446aSBoris Brezillon #include <linux/err.h>
1793db446aSBoris Brezillon #include <linux/slab.h>
1893db446aSBoris Brezillon #include <linux/module.h>
1993db446aSBoris Brezillon #include <linux/platform_device.h>
2093db446aSBoris Brezillon #include <linux/gpio/consumer.h>
2193db446aSBoris Brezillon #include <linux/io.h>
2293db446aSBoris Brezillon #include <linux/mtd/mtd.h>
2393db446aSBoris Brezillon #include <linux/mtd/rawnand.h>
2493db446aSBoris Brezillon #include <linux/mtd/partitions.h>
2593db446aSBoris Brezillon #include <linux/mtd/nand-gpio.h>
2693db446aSBoris Brezillon #include <linux/of.h>
2793db446aSBoris Brezillon #include <linux/of_address.h>
2822b27a67SBoris Brezillon #include <linux/delay.h>
2993db446aSBoris Brezillon 
3093db446aSBoris Brezillon struct gpiomtd {
31b4c71968SBoris Brezillon 	struct nand_controller	base;
3222b27a67SBoris Brezillon 	void __iomem		*io;
3393db446aSBoris Brezillon 	void __iomem		*io_sync;
3493db446aSBoris Brezillon 	struct nand_chip	nand_chip;
3593db446aSBoris Brezillon 	struct gpio_nand_platdata plat;
3693db446aSBoris Brezillon 	struct gpio_desc *nce; /* Optional chip enable */
3793db446aSBoris Brezillon 	struct gpio_desc *cle;
3893db446aSBoris Brezillon 	struct gpio_desc *ale;
3993db446aSBoris Brezillon 	struct gpio_desc *rdy;
4093db446aSBoris Brezillon 	struct gpio_desc *nwp; /* Optional write protection */
4193db446aSBoris Brezillon };
4293db446aSBoris Brezillon 
gpio_nand_getpriv(struct mtd_info * mtd)4393db446aSBoris Brezillon static inline struct gpiomtd *gpio_nand_getpriv(struct mtd_info *mtd)
4493db446aSBoris Brezillon {
4593db446aSBoris Brezillon 	return container_of(mtd_to_nand(mtd), struct gpiomtd, nand_chip);
4693db446aSBoris Brezillon }
4793db446aSBoris Brezillon 
4893db446aSBoris Brezillon 
4993db446aSBoris Brezillon #ifdef CONFIG_ARM
5093db446aSBoris Brezillon /* gpio_nand_dosync()
5193db446aSBoris Brezillon  *
5293db446aSBoris Brezillon  * Make sure the GPIO state changes occur in-order with writes to NAND
5393db446aSBoris Brezillon  * memory region.
5493db446aSBoris Brezillon  * Needed on PXA due to bus-reordering within the SoC itself (see section on
5593db446aSBoris Brezillon  * I/O ordering in PXA manual (section 2.3, p35)
5693db446aSBoris Brezillon  */
gpio_nand_dosync(struct gpiomtd * gpiomtd)5793db446aSBoris Brezillon static void gpio_nand_dosync(struct gpiomtd *gpiomtd)
5893db446aSBoris Brezillon {
5993db446aSBoris Brezillon 	unsigned long tmp;
6093db446aSBoris Brezillon 
6193db446aSBoris Brezillon 	if (gpiomtd->io_sync) {
6293db446aSBoris Brezillon 		/*
6393db446aSBoris Brezillon 		 * Linux memory barriers don't cater for what's required here.
6493db446aSBoris Brezillon 		 * What's required is what's here - a read from a separate
6593db446aSBoris Brezillon 		 * region with a dependency on that read.
6693db446aSBoris Brezillon 		 */
6793db446aSBoris Brezillon 		tmp = readl(gpiomtd->io_sync);
6893db446aSBoris Brezillon 		asm volatile("mov %1, %0\n" : "=r" (tmp) : "r" (tmp));
6993db446aSBoris Brezillon 	}
7093db446aSBoris Brezillon }
7193db446aSBoris Brezillon #else
gpio_nand_dosync(struct gpiomtd * gpiomtd)7293db446aSBoris Brezillon static inline void gpio_nand_dosync(struct gpiomtd *gpiomtd) {}
7393db446aSBoris Brezillon #endif
7493db446aSBoris Brezillon 
gpio_nand_exec_instr(struct nand_chip * chip,const struct nand_op_instr * instr)7522b27a67SBoris Brezillon static int gpio_nand_exec_instr(struct nand_chip *chip,
7622b27a67SBoris Brezillon 				const struct nand_op_instr *instr)
7722b27a67SBoris Brezillon {
7822b27a67SBoris Brezillon 	struct gpiomtd *gpiomtd = gpio_nand_getpriv(nand_to_mtd(chip));
7922b27a67SBoris Brezillon 	unsigned int i;
8022b27a67SBoris Brezillon 
8122b27a67SBoris Brezillon 	switch (instr->type) {
8222b27a67SBoris Brezillon 	case NAND_OP_CMD_INSTR:
8322b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
8422b27a67SBoris Brezillon 		gpiod_set_value(gpiomtd->cle, 1);
8522b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
8622b27a67SBoris Brezillon 		writeb(instr->ctx.cmd.opcode, gpiomtd->io);
8722b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
8822b27a67SBoris Brezillon 		gpiod_set_value(gpiomtd->cle, 0);
8922b27a67SBoris Brezillon 		return 0;
9022b27a67SBoris Brezillon 
9122b27a67SBoris Brezillon 	case NAND_OP_ADDR_INSTR:
9222b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
9322b27a67SBoris Brezillon 		gpiod_set_value(gpiomtd->ale, 1);
9422b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
9522b27a67SBoris Brezillon 		for (i = 0; i < instr->ctx.addr.naddrs; i++)
9622b27a67SBoris Brezillon 			writeb(instr->ctx.addr.addrs[i], gpiomtd->io);
9722b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
9822b27a67SBoris Brezillon 		gpiod_set_value(gpiomtd->ale, 0);
9922b27a67SBoris Brezillon 		return 0;
10022b27a67SBoris Brezillon 
10122b27a67SBoris Brezillon 	case NAND_OP_DATA_IN_INSTR:
10222b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
10322b27a67SBoris Brezillon 		if ((chip->options & NAND_BUSWIDTH_16) &&
10422b27a67SBoris Brezillon 		    !instr->ctx.data.force_8bit)
10522b27a67SBoris Brezillon 			ioread16_rep(gpiomtd->io, instr->ctx.data.buf.in,
10622b27a67SBoris Brezillon 				     instr->ctx.data.len / 2);
10722b27a67SBoris Brezillon 		else
10822b27a67SBoris Brezillon 			ioread8_rep(gpiomtd->io, instr->ctx.data.buf.in,
10922b27a67SBoris Brezillon 				    instr->ctx.data.len);
11022b27a67SBoris Brezillon 		return 0;
11122b27a67SBoris Brezillon 
11222b27a67SBoris Brezillon 	case NAND_OP_DATA_OUT_INSTR:
11322b27a67SBoris Brezillon 		gpio_nand_dosync(gpiomtd);
11422b27a67SBoris Brezillon 		if ((chip->options & NAND_BUSWIDTH_16) &&
11522b27a67SBoris Brezillon 		    !instr->ctx.data.force_8bit)
11622b27a67SBoris Brezillon 			iowrite16_rep(gpiomtd->io, instr->ctx.data.buf.out,
11722b27a67SBoris Brezillon 				      instr->ctx.data.len / 2);
11822b27a67SBoris Brezillon 		else
11922b27a67SBoris Brezillon 			iowrite8_rep(gpiomtd->io, instr->ctx.data.buf.out,
12022b27a67SBoris Brezillon 				     instr->ctx.data.len);
12122b27a67SBoris Brezillon 		return 0;
12222b27a67SBoris Brezillon 
12322b27a67SBoris Brezillon 	case NAND_OP_WAITRDY_INSTR:
12422b27a67SBoris Brezillon 		if (!gpiomtd->rdy)
12522b27a67SBoris Brezillon 			return nand_soft_waitrdy(chip, instr->ctx.waitrdy.timeout_ms);
12622b27a67SBoris Brezillon 
12722b27a67SBoris Brezillon 		return nand_gpio_waitrdy(chip, gpiomtd->rdy,
12822b27a67SBoris Brezillon 					 instr->ctx.waitrdy.timeout_ms);
12922b27a67SBoris Brezillon 
13022b27a67SBoris Brezillon 	default:
13122b27a67SBoris Brezillon 		return -EINVAL;
13222b27a67SBoris Brezillon 	}
13322b27a67SBoris Brezillon 
13422b27a67SBoris Brezillon 	return 0;
13522b27a67SBoris Brezillon }
13622b27a67SBoris Brezillon 
gpio_nand_exec_op(struct nand_chip * chip,const struct nand_operation * op,bool check_only)13722b27a67SBoris Brezillon static int gpio_nand_exec_op(struct nand_chip *chip,
13822b27a67SBoris Brezillon 			     const struct nand_operation *op,
13922b27a67SBoris Brezillon 			     bool check_only)
14022b27a67SBoris Brezillon {
14122b27a67SBoris Brezillon 	struct gpiomtd *gpiomtd = gpio_nand_getpriv(nand_to_mtd(chip));
14222b27a67SBoris Brezillon 	unsigned int i;
14322b27a67SBoris Brezillon 	int ret = 0;
14422b27a67SBoris Brezillon 
14522b27a67SBoris Brezillon 	if (check_only)
14622b27a67SBoris Brezillon 		return 0;
14722b27a67SBoris Brezillon 
14822b27a67SBoris Brezillon 	gpio_nand_dosync(gpiomtd);
14922b27a67SBoris Brezillon 	gpiod_set_value(gpiomtd->nce, 0);
15022b27a67SBoris Brezillon 	for (i = 0; i < op->ninstrs; i++) {
15122b27a67SBoris Brezillon 		ret = gpio_nand_exec_instr(chip, &op->instrs[i]);
15222b27a67SBoris Brezillon 		if (ret)
15322b27a67SBoris Brezillon 			break;
15422b27a67SBoris Brezillon 
15522b27a67SBoris Brezillon 		if (op->instrs[i].delay_ns)
15622b27a67SBoris Brezillon 			ndelay(op->instrs[i].delay_ns);
15722b27a67SBoris Brezillon 	}
15822b27a67SBoris Brezillon 	gpio_nand_dosync(gpiomtd);
15922b27a67SBoris Brezillon 	gpiod_set_value(gpiomtd->nce, 1);
16022b27a67SBoris Brezillon 
16122b27a67SBoris Brezillon 	return ret;
16222b27a67SBoris Brezillon }
16322b27a67SBoris Brezillon 
gpio_nand_attach_chip(struct nand_chip * chip)164f6341f64SMiquel Raynal static int gpio_nand_attach_chip(struct nand_chip *chip)
165f6341f64SMiquel Raynal {
166b5b5b4dcSMiquel Raynal 	if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_SOFT &&
167b5b5b4dcSMiquel Raynal 	    chip->ecc.algo == NAND_ECC_ALGO_UNKNOWN)
168f6341f64SMiquel Raynal 		chip->ecc.algo = NAND_ECC_ALGO_HAMMING;
169f6341f64SMiquel Raynal 
170f6341f64SMiquel Raynal 	return 0;
171f6341f64SMiquel Raynal }
172f6341f64SMiquel Raynal 
17322b27a67SBoris Brezillon static const struct nand_controller_ops gpio_nand_ops = {
17422b27a67SBoris Brezillon 	.exec_op = gpio_nand_exec_op,
175f6341f64SMiquel Raynal 	.attach_chip = gpio_nand_attach_chip,
17622b27a67SBoris Brezillon };
17722b27a67SBoris Brezillon 
17893db446aSBoris Brezillon #ifdef CONFIG_OF
17993db446aSBoris Brezillon static const struct of_device_id gpio_nand_id_table[] = {
18093db446aSBoris Brezillon 	{ .compatible = "gpio-control-nand" },
18193db446aSBoris Brezillon 	{}
18293db446aSBoris Brezillon };
18393db446aSBoris Brezillon MODULE_DEVICE_TABLE(of, gpio_nand_id_table);
18493db446aSBoris Brezillon 
gpio_nand_get_config_of(const struct device * dev,struct gpio_nand_platdata * plat)18593db446aSBoris Brezillon static int gpio_nand_get_config_of(const struct device *dev,
18693db446aSBoris Brezillon 				   struct gpio_nand_platdata *plat)
18793db446aSBoris Brezillon {
18893db446aSBoris Brezillon 	u32 val;
18993db446aSBoris Brezillon 
19093db446aSBoris Brezillon 	if (!dev->of_node)
19193db446aSBoris Brezillon 		return -ENODEV;
19293db446aSBoris Brezillon 
19393db446aSBoris Brezillon 	if (!of_property_read_u32(dev->of_node, "bank-width", &val)) {
19493db446aSBoris Brezillon 		if (val == 2) {
19593db446aSBoris Brezillon 			plat->options |= NAND_BUSWIDTH_16;
19693db446aSBoris Brezillon 		} else if (val != 1) {
19793db446aSBoris Brezillon 			dev_err(dev, "invalid bank-width %u\n", val);
19893db446aSBoris Brezillon 			return -EINVAL;
19993db446aSBoris Brezillon 		}
20093db446aSBoris Brezillon 	}
20193db446aSBoris Brezillon 
20293db446aSBoris Brezillon 	if (!of_property_read_u32(dev->of_node, "chip-delay", &val))
20393db446aSBoris Brezillon 		plat->chip_delay = val;
20493db446aSBoris Brezillon 
20593db446aSBoris Brezillon 	return 0;
20693db446aSBoris Brezillon }
20793db446aSBoris Brezillon 
gpio_nand_get_io_sync_of(struct platform_device * pdev)20893db446aSBoris Brezillon static struct resource *gpio_nand_get_io_sync_of(struct platform_device *pdev)
20993db446aSBoris Brezillon {
21093db446aSBoris Brezillon 	struct resource *r;
21193db446aSBoris Brezillon 	u64 addr;
21293db446aSBoris Brezillon 
21393db446aSBoris Brezillon 	if (of_property_read_u64(pdev->dev.of_node,
21493db446aSBoris Brezillon 				       "gpio-control-nand,io-sync-reg", &addr))
21593db446aSBoris Brezillon 		return NULL;
21693db446aSBoris Brezillon 
21793db446aSBoris Brezillon 	r = devm_kzalloc(&pdev->dev, sizeof(*r), GFP_KERNEL);
21893db446aSBoris Brezillon 	if (!r)
21993db446aSBoris Brezillon 		return NULL;
22093db446aSBoris Brezillon 
22193db446aSBoris Brezillon 	r->start = addr;
22293db446aSBoris Brezillon 	r->end = r->start + 0x3;
22393db446aSBoris Brezillon 	r->flags = IORESOURCE_MEM;
22493db446aSBoris Brezillon 
22593db446aSBoris Brezillon 	return r;
22693db446aSBoris Brezillon }
22793db446aSBoris Brezillon #else /* CONFIG_OF */
gpio_nand_get_config_of(const struct device * dev,struct gpio_nand_platdata * plat)22893db446aSBoris Brezillon static inline int gpio_nand_get_config_of(const struct device *dev,
22993db446aSBoris Brezillon 					  struct gpio_nand_platdata *plat)
23093db446aSBoris Brezillon {
23193db446aSBoris Brezillon 	return -ENOSYS;
23293db446aSBoris Brezillon }
23393db446aSBoris Brezillon 
23493db446aSBoris Brezillon static inline struct resource *
gpio_nand_get_io_sync_of(struct platform_device * pdev)23593db446aSBoris Brezillon gpio_nand_get_io_sync_of(struct platform_device *pdev)
23693db446aSBoris Brezillon {
23793db446aSBoris Brezillon 	return NULL;
23893db446aSBoris Brezillon }
23993db446aSBoris Brezillon #endif /* CONFIG_OF */
24093db446aSBoris Brezillon 
gpio_nand_get_config(const struct device * dev,struct gpio_nand_platdata * plat)24193db446aSBoris Brezillon static inline int gpio_nand_get_config(const struct device *dev,
24293db446aSBoris Brezillon 				       struct gpio_nand_platdata *plat)
24393db446aSBoris Brezillon {
24493db446aSBoris Brezillon 	int ret = gpio_nand_get_config_of(dev, plat);
24593db446aSBoris Brezillon 
24693db446aSBoris Brezillon 	if (!ret)
24793db446aSBoris Brezillon 		return ret;
24893db446aSBoris Brezillon 
24993db446aSBoris Brezillon 	if (dev_get_platdata(dev)) {
25093db446aSBoris Brezillon 		memcpy(plat, dev_get_platdata(dev), sizeof(*plat));
25193db446aSBoris Brezillon 		return 0;
25293db446aSBoris Brezillon 	}
25393db446aSBoris Brezillon 
25493db446aSBoris Brezillon 	return -EINVAL;
25593db446aSBoris Brezillon }
25693db446aSBoris Brezillon 
25793db446aSBoris Brezillon static inline struct resource *
gpio_nand_get_io_sync(struct platform_device * pdev)25893db446aSBoris Brezillon gpio_nand_get_io_sync(struct platform_device *pdev)
25993db446aSBoris Brezillon {
26093db446aSBoris Brezillon 	struct resource *r = gpio_nand_get_io_sync_of(pdev);
26193db446aSBoris Brezillon 
26293db446aSBoris Brezillon 	if (r)
26393db446aSBoris Brezillon 		return r;
26493db446aSBoris Brezillon 
26593db446aSBoris Brezillon 	return platform_get_resource(pdev, IORESOURCE_MEM, 1);
26693db446aSBoris Brezillon }
26793db446aSBoris Brezillon 
gpio_nand_remove(struct platform_device * pdev)268*ec185b18SUwe Kleine-König static void gpio_nand_remove(struct platform_device *pdev)
26993db446aSBoris Brezillon {
27093db446aSBoris Brezillon 	struct gpiomtd *gpiomtd = platform_get_drvdata(pdev);
271dbe02415SMiquel Raynal 	struct nand_chip *chip = &gpiomtd->nand_chip;
272dbe02415SMiquel Raynal 	int ret;
27393db446aSBoris Brezillon 
274dbe02415SMiquel Raynal 	ret = mtd_device_unregister(nand_to_mtd(chip));
275dbe02415SMiquel Raynal 	WARN_ON(ret);
276dbe02415SMiquel Raynal 	nand_cleanup(chip);
27793db446aSBoris Brezillon 
27893db446aSBoris Brezillon 	/* Enable write protection and disable the chip */
27993db446aSBoris Brezillon 	if (gpiomtd->nwp && !IS_ERR(gpiomtd->nwp))
28093db446aSBoris Brezillon 		gpiod_set_value(gpiomtd->nwp, 0);
28193db446aSBoris Brezillon 	if (gpiomtd->nce && !IS_ERR(gpiomtd->nce))
28293db446aSBoris Brezillon 		gpiod_set_value(gpiomtd->nce, 0);
28393db446aSBoris Brezillon }
28493db446aSBoris Brezillon 
gpio_nand_probe(struct platform_device * pdev)28593db446aSBoris Brezillon static int gpio_nand_probe(struct platform_device *pdev)
28693db446aSBoris Brezillon {
28793db446aSBoris Brezillon 	struct gpiomtd *gpiomtd;
28893db446aSBoris Brezillon 	struct nand_chip *chip;
28993db446aSBoris Brezillon 	struct mtd_info *mtd;
29093db446aSBoris Brezillon 	struct resource *res;
29193db446aSBoris Brezillon 	struct device *dev = &pdev->dev;
29293db446aSBoris Brezillon 	int ret = 0;
29393db446aSBoris Brezillon 
29493db446aSBoris Brezillon 	if (!dev->of_node && !dev_get_platdata(dev))
29593db446aSBoris Brezillon 		return -EINVAL;
29693db446aSBoris Brezillon 
29793db446aSBoris Brezillon 	gpiomtd = devm_kzalloc(dev, sizeof(*gpiomtd), GFP_KERNEL);
29893db446aSBoris Brezillon 	if (!gpiomtd)
29993db446aSBoris Brezillon 		return -ENOMEM;
30093db446aSBoris Brezillon 
30193db446aSBoris Brezillon 	chip = &gpiomtd->nand_chip;
30293db446aSBoris Brezillon 
303557de1cfSCai Huoqing 	gpiomtd->io = devm_platform_ioremap_resource(pdev, 0);
30422b27a67SBoris Brezillon 	if (IS_ERR(gpiomtd->io))
30522b27a67SBoris Brezillon 		return PTR_ERR(gpiomtd->io);
30693db446aSBoris Brezillon 
30793db446aSBoris Brezillon 	res = gpio_nand_get_io_sync(pdev);
30893db446aSBoris Brezillon 	if (res) {
30993db446aSBoris Brezillon 		gpiomtd->io_sync = devm_ioremap_resource(dev, res);
31093db446aSBoris Brezillon 		if (IS_ERR(gpiomtd->io_sync))
31193db446aSBoris Brezillon 			return PTR_ERR(gpiomtd->io_sync);
31293db446aSBoris Brezillon 	}
31393db446aSBoris Brezillon 
31493db446aSBoris Brezillon 	ret = gpio_nand_get_config(dev, &gpiomtd->plat);
31593db446aSBoris Brezillon 	if (ret)
31693db446aSBoris Brezillon 		return ret;
31793db446aSBoris Brezillon 
31893db446aSBoris Brezillon 	/* Just enable the chip */
31993db446aSBoris Brezillon 	gpiomtd->nce = devm_gpiod_get_optional(dev, "nce", GPIOD_OUT_HIGH);
32093db446aSBoris Brezillon 	if (IS_ERR(gpiomtd->nce))
32193db446aSBoris Brezillon 		return PTR_ERR(gpiomtd->nce);
32293db446aSBoris Brezillon 
32393db446aSBoris Brezillon 	/* We disable write protection once we know probe() will succeed */
32493db446aSBoris Brezillon 	gpiomtd->nwp = devm_gpiod_get_optional(dev, "nwp", GPIOD_OUT_LOW);
32593db446aSBoris Brezillon 	if (IS_ERR(gpiomtd->nwp)) {
32693db446aSBoris Brezillon 		ret = PTR_ERR(gpiomtd->nwp);
32793db446aSBoris Brezillon 		goto out_ce;
32893db446aSBoris Brezillon 	}
32993db446aSBoris Brezillon 
33093db446aSBoris Brezillon 	gpiomtd->ale = devm_gpiod_get(dev, "ale", GPIOD_OUT_LOW);
33193db446aSBoris Brezillon 	if (IS_ERR(gpiomtd->ale)) {
33293db446aSBoris Brezillon 		ret = PTR_ERR(gpiomtd->ale);
33393db446aSBoris Brezillon 		goto out_ce;
33493db446aSBoris Brezillon 	}
33593db446aSBoris Brezillon 
33693db446aSBoris Brezillon 	gpiomtd->cle = devm_gpiod_get(dev, "cle", GPIOD_OUT_LOW);
33793db446aSBoris Brezillon 	if (IS_ERR(gpiomtd->cle)) {
33893db446aSBoris Brezillon 		ret = PTR_ERR(gpiomtd->cle);
33993db446aSBoris Brezillon 		goto out_ce;
34093db446aSBoris Brezillon 	}
34193db446aSBoris Brezillon 
34293db446aSBoris Brezillon 	gpiomtd->rdy = devm_gpiod_get_optional(dev, "rdy", GPIOD_IN);
34393db446aSBoris Brezillon 	if (IS_ERR(gpiomtd->rdy)) {
34493db446aSBoris Brezillon 		ret = PTR_ERR(gpiomtd->rdy);
34593db446aSBoris Brezillon 		goto out_ce;
34693db446aSBoris Brezillon 	}
34793db446aSBoris Brezillon 
348b4c71968SBoris Brezillon 	nand_controller_init(&gpiomtd->base);
34922b27a67SBoris Brezillon 	gpiomtd->base.ops = &gpio_nand_ops;
35022b27a67SBoris Brezillon 
35193db446aSBoris Brezillon 	nand_set_flash_node(chip, pdev->dev.of_node);
35293db446aSBoris Brezillon 	chip->options		= gpiomtd->plat.options;
353b4c71968SBoris Brezillon 	chip->controller	= &gpiomtd->base;
35493db446aSBoris Brezillon 
35593db446aSBoris Brezillon 	mtd			= nand_to_mtd(chip);
35693db446aSBoris Brezillon 	mtd->dev.parent		= dev;
35793db446aSBoris Brezillon 
35893db446aSBoris Brezillon 	platform_set_drvdata(pdev, gpiomtd);
35993db446aSBoris Brezillon 
36093db446aSBoris Brezillon 	/* Disable write protection, if wired up */
36193db446aSBoris Brezillon 	if (gpiomtd->nwp && !IS_ERR(gpiomtd->nwp))
36293db446aSBoris Brezillon 		gpiod_direction_output(gpiomtd->nwp, 1);
36393db446aSBoris Brezillon 
364b5b5b4dcSMiquel Raynal 	/*
365b5b5b4dcSMiquel Raynal 	 * This driver assumes that the default ECC engine should be TYPE_SOFT.
366b5b5b4dcSMiquel Raynal 	 * Set ->engine_type before registering the NAND devices in order to
367b5b5b4dcSMiquel Raynal 	 * provide a driver specific default value.
368b5b5b4dcSMiquel Raynal 	 */
369b5b5b4dcSMiquel Raynal 	chip->ecc.engine_type = NAND_ECC_ENGINE_TYPE_SOFT;
370b5b5b4dcSMiquel Raynal 
37100ad378fSBoris Brezillon 	ret = nand_scan(chip, 1);
37293db446aSBoris Brezillon 	if (ret)
37393db446aSBoris Brezillon 		goto err_wp;
37493db446aSBoris Brezillon 
37593db446aSBoris Brezillon 	if (gpiomtd->plat.adjust_parts)
37693db446aSBoris Brezillon 		gpiomtd->plat.adjust_parts(&gpiomtd->plat, mtd->size);
37793db446aSBoris Brezillon 
37893db446aSBoris Brezillon 	ret = mtd_device_register(mtd, gpiomtd->plat.parts,
37993db446aSBoris Brezillon 				  gpiomtd->plat.num_parts);
38093db446aSBoris Brezillon 	if (!ret)
38193db446aSBoris Brezillon 		return 0;
38293db446aSBoris Brezillon 
38393db446aSBoris Brezillon err_wp:
38493db446aSBoris Brezillon 	if (gpiomtd->nwp && !IS_ERR(gpiomtd->nwp))
38593db446aSBoris Brezillon 		gpiod_set_value(gpiomtd->nwp, 0);
38693db446aSBoris Brezillon out_ce:
38793db446aSBoris Brezillon 	if (gpiomtd->nce && !IS_ERR(gpiomtd->nce))
38893db446aSBoris Brezillon 		gpiod_set_value(gpiomtd->nce, 0);
38993db446aSBoris Brezillon 
39093db446aSBoris Brezillon 	return ret;
39193db446aSBoris Brezillon }
39293db446aSBoris Brezillon 
39393db446aSBoris Brezillon static struct platform_driver gpio_nand_driver = {
39493db446aSBoris Brezillon 	.probe		= gpio_nand_probe,
395*ec185b18SUwe Kleine-König 	.remove_new	= gpio_nand_remove,
39693db446aSBoris Brezillon 	.driver		= {
39793db446aSBoris Brezillon 		.name	= "gpio-nand",
39893db446aSBoris Brezillon 		.of_match_table = of_match_ptr(gpio_nand_id_table),
39993db446aSBoris Brezillon 	},
40093db446aSBoris Brezillon };
40193db446aSBoris Brezillon 
40293db446aSBoris Brezillon module_platform_driver(gpio_nand_driver);
40393db446aSBoris Brezillon 
40493db446aSBoris Brezillon MODULE_LICENSE("GPL");
40593db446aSBoris Brezillon MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
40693db446aSBoris Brezillon MODULE_DESCRIPTION("GPIO NAND Driver");
407