OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / mtd / nand / nuc900_nand.c
blob8febe46e1105e9aad7212dd442e4160d855fe11d
1 /*
2 * Copyright © 2009 Nuvoton technology corporation.
4 * Wan ZongShun <mcuos.com@gmail.com>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation;version 2 of the License.
12 #include <linux/slab.h>
13 #include <linux/init.h>
14 #include <linux/module.h>
15 #include <linux/interrupt.h>
16 #include <linux/io.h>
17 #include <linux/platform_device.h>
18 #include <linux/delay.h>
19 #include <linux/clk.h>
20 #include <linux/err.h>
22 #include <linux/mtd/mtd.h>
23 #include <linux/mtd/nand.h>
24 #include <linux/mtd/partitions.h>
26 #define REG_FMICSR 0x00
27 #define REG_SMCSR 0xa0
28 #define REG_SMISR 0xac
29 #define REG_SMCMD 0xb0
30 #define REG_SMADDR 0xb4
31 #define REG_SMDATA 0xb8
33 #define RESET_FMI 0x01
34 #define NAND_EN 0x08
35 #define READYBUSY (0x01 << 18)
37 #define SWRST 0x01
38 #define PSIZE (0x01 << 3)
39 #define DMARWEN (0x03 << 1)
40 #define BUSWID (0x01 << 4)
41 #define ECC4EN (0x01 << 5)
42 #define WP (0x01 << 24)
43 #define NANDCS (0x01 << 25)
44 #define ENDADDR (0x01 << 31)
46 #define read_data_reg(dev) \
47 __raw_readl((dev)->reg + REG_SMDATA)
49 #define write_data_reg(dev, val) \
50 __raw_writel((val), (dev)->reg + REG_SMDATA)
52 #define write_cmd_reg(dev, val) \
53 __raw_writel((val), (dev)->reg + REG_SMCMD)
55 #define write_addr_reg(dev, val) \
56 __raw_writel((val), (dev)->reg + REG_SMADDR)
58 struct nuc900_nand {
59 struct mtd_info mtd;
60 struct nand_chip chip;
61 void __iomem *reg;
62 struct clk *clk;
63 spinlock_t lock;
66 static const struct mtd_partition partitions[] = {
68 .name = "NAND FS 0",
69 .offset = 0,
70 .size = 8 * 1024 * 1024
73 .name = "NAND FS 1",
74 .offset = MTDPART_OFS_APPEND,
75 .size = MTDPART_SIZ_FULL
79 static unsigned char nuc900_nand_read_byte(struct mtd_info *mtd)
81 unsigned char ret;
82 struct nuc900_nand *nand;
84 nand = container_of(mtd, struct nuc900_nand, mtd);
86 ret = (unsigned char)read_data_reg(nand);
88 return ret;
91 static void nuc900_nand_read_buf(struct mtd_info *mtd,
92 unsigned char *buf, int len)
94 int i;
95 struct nuc900_nand *nand;
97 nand = container_of(mtd, struct nuc900_nand, mtd);
99 for (i = 0; i < len; i++)
100 buf[i] = (unsigned char)read_data_reg(nand);
103 static void nuc900_nand_write_buf(struct mtd_info *mtd,
104 const unsigned char *buf, int len)
106 int i;
107 struct nuc900_nand *nand;
109 nand = container_of(mtd, struct nuc900_nand, mtd);
111 for (i = 0; i < len; i++)
112 write_data_reg(nand, buf[i]);
115 static int nuc900_verify_buf(struct mtd_info *mtd,
116 const unsigned char *buf, int len)
118 int i;
119 struct nuc900_nand *nand;
121 nand = container_of(mtd, struct nuc900_nand, mtd);
123 for (i = 0; i < len; i++) {
124 if (buf[i] != (unsigned char)read_data_reg(nand))
125 return -EFAULT;
128 return 0;
131 static int nuc900_check_rb(struct nuc900_nand *nand)
133 unsigned int val;
134 spin_lock(&nand->lock);
135 val = __raw_readl(REG_SMISR);
136 val &= READYBUSY;
137 spin_unlock(&nand->lock);
139 return val;
142 static int nuc900_nand_devready(struct mtd_info *mtd)
144 struct nuc900_nand *nand;
145 int ready;
147 nand = container_of(mtd, struct nuc900_nand, mtd);
149 ready = (nuc900_check_rb(nand)) ? 1 : 0;
150 return ready;
153 static void nuc900_nand_command_lp(struct mtd_info *mtd, unsigned int command,
154 int column, int page_addr)
156 register struct nand_chip *chip = mtd->priv;
157 struct nuc900_nand *nand;
159 nand = container_of(mtd, struct nuc900_nand, mtd);
161 if (command == NAND_CMD_READOOB) {
162 column += mtd->writesize;
163 command = NAND_CMD_READ0;
166 write_cmd_reg(nand, command & 0xff);
168 if (column != -1 || page_addr != -1) {
170 if (column != -1) {
171 if (chip->options & NAND_BUSWIDTH_16)
172 column >>= 1;
173 write_addr_reg(nand, column);
174 write_addr_reg(nand, column >> 8 | ENDADDR);
176 if (page_addr != -1) {
177 write_addr_reg(nand, page_addr);
179 if (chip->chipsize > (128 << 20)) {
180 write_addr_reg(nand, page_addr >> 8);
181 write_addr_reg(nand, page_addr >> 16 | ENDADDR);
182 } else {
183 write_addr_reg(nand, page_addr >> 8 | ENDADDR);
188 switch (command) {
189 case NAND_CMD_CACHEDPROG:
190 case NAND_CMD_PAGEPROG:
191 case NAND_CMD_ERASE1:
192 case NAND_CMD_ERASE2:
193 case NAND_CMD_SEQIN:
194 case NAND_CMD_RNDIN:
195 case NAND_CMD_STATUS:
196 case NAND_CMD_DEPLETE1:
197 return;
199 case NAND_CMD_STATUS_ERROR:
200 case NAND_CMD_STATUS_ERROR0:
201 case NAND_CMD_STATUS_ERROR1:
202 case NAND_CMD_STATUS_ERROR2:
203 case NAND_CMD_STATUS_ERROR3:
204 udelay(chip->chip_delay);
205 return;
207 case NAND_CMD_RESET:
208 if (chip->dev_ready)
209 break;
210 udelay(chip->chip_delay);
212 write_cmd_reg(nand, NAND_CMD_STATUS);
213 write_cmd_reg(nand, command);
215 while (!nuc900_check_rb(nand))
218 return;
220 case NAND_CMD_RNDOUT:
221 write_cmd_reg(nand, NAND_CMD_RNDOUTSTART);
222 return;
224 case NAND_CMD_READ0:
226 write_cmd_reg(nand, NAND_CMD_READSTART);
227 default:
229 if (!chip->dev_ready) {
230 udelay(chip->chip_delay);
231 return;
235 /* Apply this short delay always to ensure that we do wait tWB in
236 * any case on any machine. */
237 ndelay(100);
239 while (!chip->dev_ready(mtd))
244 static void nuc900_nand_enable(struct nuc900_nand *nand)
246 unsigned int val;
247 spin_lock(&nand->lock);
248 __raw_writel(RESET_FMI, (nand->reg + REG_FMICSR));
250 val = __raw_readl(nand->reg + REG_FMICSR);
252 if (!(val & NAND_EN))
253 __raw_writel(val | NAND_EN, REG_FMICSR);
255 val = __raw_readl(nand->reg + REG_SMCSR);
257 val &= ~(SWRST|PSIZE|DMARWEN|BUSWID|ECC4EN|NANDCS);
258 val |= WP;
260 __raw_writel(val, nand->reg + REG_SMCSR);
262 spin_unlock(&nand->lock);
265 static int __devinit nuc900_nand_probe(struct platform_device *pdev)
267 struct nuc900_nand *nuc900_nand;
268 struct nand_chip *chip;
269 int retval;
270 struct resource *res;
272 retval = 0;
274 nuc900_nand = kzalloc(sizeof(struct nuc900_nand), GFP_KERNEL);
275 if (!nuc900_nand)
276 return -ENOMEM;
277 chip = &(nuc900_nand->chip);
279 nuc900_nand->mtd.priv = chip;
280 nuc900_nand->mtd.owner = THIS_MODULE;
281 spin_lock_init(&nuc900_nand->lock);
283 nuc900_nand->clk = clk_get(&pdev->dev, NULL);
284 if (IS_ERR(nuc900_nand->clk)) {
285 retval = -ENOENT;
286 goto fail1;
288 clk_enable(nuc900_nand->clk);
290 chip->cmdfunc = nuc900_nand_command_lp;
291 chip->dev_ready = nuc900_nand_devready;
292 chip->read_byte = nuc900_nand_read_byte;
293 chip->write_buf = nuc900_nand_write_buf;
294 chip->read_buf = nuc900_nand_read_buf;
295 chip->verify_buf = nuc900_verify_buf;
296 chip->chip_delay = 50;
297 chip->options = 0;
298 chip->ecc.mode = NAND_ECC_SOFT;
300 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
301 if (!res) {
302 retval = -ENXIO;
303 goto fail1;
306 if (!request_mem_region(res->start, resource_size(res), pdev->name)) {
307 retval = -EBUSY;
308 goto fail1;
311 nuc900_nand->reg = ioremap(res->start, resource_size(res));
312 if (!nuc900_nand->reg) {
313 retval = -ENOMEM;
314 goto fail2;
317 nuc900_nand_enable(nuc900_nand);
319 if (nand_scan(&(nuc900_nand->mtd), 1)) {
320 retval = -ENXIO;
321 goto fail3;
324 mtd_device_register(&(nuc900_nand->mtd), partitions,
325 ARRAY_SIZE(partitions));
327 platform_set_drvdata(pdev, nuc900_nand);
329 return retval;
331 fail3: iounmap(nuc900_nand->reg);
332 fail2: release_mem_region(res->start, resource_size(res));
333 fail1: kfree(nuc900_nand);
334 return retval;
337 static int __devexit nuc900_nand_remove(struct platform_device *pdev)
339 struct nuc900_nand *nuc900_nand = platform_get_drvdata(pdev);
340 struct resource *res;
342 nand_release(&nuc900_nand->mtd);
343 iounmap(nuc900_nand->reg);
345 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
346 release_mem_region(res->start, resource_size(res));
348 clk_disable(nuc900_nand->clk);
349 clk_put(nuc900_nand->clk);
351 kfree(nuc900_nand);
353 platform_set_drvdata(pdev, NULL);
355 return 0;
358 static struct platform_driver nuc900_nand_driver = {
359 .probe = nuc900_nand_probe,
360 .remove = __devexit_p(nuc900_nand_remove),
361 .driver = {
362 .name = "nuc900-fmi",
363 .owner = THIS_MODULE,
367 module_platform_driver(nuc900_nand_driver);
369 MODULE_AUTHOR("Wan ZongShun <mcuos.com@gmail.com>");
370 MODULE_DESCRIPTION("w90p910/NUC9xx nand driver!");
371 MODULE_LICENSE("GPL");
372 MODULE_ALIAS("platform:nuc900-fmi");