forked from ~ljy/RK356X_SDK_RELEASE

hc
2023-12-11 d2ccde1c8e90d38cee87a1b0309ad2827f3fd30d
kernel/drivers/mtd/nand/raw/orion_nand.c
....@@ -22,13 +22,14 @@
2222 #include <linux/platform_data/mtd-orion_nand.h>
2323
2424 struct orion_nand_info {
25
+ struct nand_controller controller;
2526 struct nand_chip chip;
2627 struct clk *clk;
2728 };
2829
29
-static void orion_nand_cmd_ctrl(struct mtd_info *mtd, int cmd, unsigned int ctrl)
30
+static void orion_nand_cmd_ctrl(struct nand_chip *nc, int cmd,
31
+ unsigned int ctrl)
3032 {
31
- struct nand_chip *nc = mtd_to_nand(mtd);
3233 struct orion_nand_data *board = nand_get_controller_data(nc);
3334 u32 offs;
3435
....@@ -45,13 +46,12 @@
4546 if (nc->options & NAND_BUSWIDTH_16)
4647 offs <<= 1;
4748
48
- writeb(cmd, nc->IO_ADDR_W + offs);
49
+ writeb(cmd, nc->legacy.IO_ADDR_W + offs);
4950 }
5051
51
-static void orion_nand_read_buf(struct mtd_info *mtd, uint8_t *buf, int len)
52
+static void orion_nand_read_buf(struct nand_chip *chip, uint8_t *buf, int len)
5253 {
53
- struct nand_chip *chip = mtd_to_nand(mtd);
54
- void __iomem *io_base = chip->IO_ADDR_R;
54
+ void __iomem *io_base = chip->legacy.IO_ADDR_R;
5555 #if defined(__LINUX_ARM_ARCH__) && __LINUX_ARM_ARCH__ >= 5
5656 uint64_t *buf64;
5757 #endif
....@@ -83,6 +83,19 @@
8383 buf[i++] = readb(io_base);
8484 }
8585
86
+static int orion_nand_attach_chip(struct nand_chip *chip)
87
+{
88
+ if (chip->ecc.engine_type == NAND_ECC_ENGINE_TYPE_SOFT &&
89
+ chip->ecc.algo == NAND_ECC_ALGO_UNKNOWN)
90
+ chip->ecc.algo = NAND_ECC_ALGO_HAMMING;
91
+
92
+ return 0;
93
+}
94
+
95
+static const struct nand_controller_ops orion_nand_ops = {
96
+ .attach_chip = orion_nand_attach_chip,
97
+};
98
+
8699 static int __init orion_nand_probe(struct platform_device *pdev)
87100 {
88101 struct orion_nand_info *info;
....@@ -101,6 +114,10 @@
101114 return -ENOMEM;
102115 nc = &info->chip;
103116 mtd = nand_to_mtd(nc);
117
+
118
+ nand_controller_init(&info->controller);
119
+ info->controller.ops = &orion_nand_ops;
120
+ nc->controller = &info->controller;
104121
105122 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
106123 io_base = devm_ioremap_resource(&pdev->dev, res);
....@@ -137,14 +154,12 @@
137154
138155 nand_set_controller_data(nc, board);
139156 nand_set_flash_node(nc, pdev->dev.of_node);
140
- nc->IO_ADDR_R = nc->IO_ADDR_W = io_base;
141
- nc->cmd_ctrl = orion_nand_cmd_ctrl;
142
- nc->read_buf = orion_nand_read_buf;
143
- nc->ecc.mode = NAND_ECC_SOFT;
144
- nc->ecc.algo = NAND_ECC_HAMMING;
157
+ nc->legacy.IO_ADDR_R = nc->legacy.IO_ADDR_W = io_base;
158
+ nc->legacy.cmd_ctrl = orion_nand_cmd_ctrl;
159
+ nc->legacy.read_buf = orion_nand_read_buf;
145160
146161 if (board->chip_delay)
147
- nc->chip_delay = board->chip_delay;
162
+ nc->legacy.chip_delay = board->chip_delay;
148163
149164 WARN(board->width > 16,
150165 "%d bit bus width out of range",
....@@ -174,6 +189,13 @@
174189 return ret;
175190 }
176191
192
+ /*
193
+ * This driver assumes that the default ECC engine should be TYPE_SOFT.
194
+ * Set ->engine_type before registering the NAND devices in order to
195
+ * provide a driver specific default value.
196
+ */
197
+ nc->ecc.engine_type = NAND_ECC_ENGINE_TYPE_SOFT;
198
+
177199 ret = nand_scan(nc, 1);
178200 if (ret)
179201 goto no_dev;
....@@ -196,8 +218,12 @@
196218 {
197219 struct orion_nand_info *info = platform_get_drvdata(pdev);
198220 struct nand_chip *chip = &info->chip;
221
+ int ret;
199222
200
- nand_release(chip);
223
+ ret = mtd_device_unregister(nand_to_mtd(chip));
224
+ WARN_ON(ret);
225
+
226
+ nand_cleanup(chip);
201227
202228 clk_disable_unprepare(info->clk);
203229