?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / mtd / onenand / omap2.c
blob6547c84afc3a4bd6cde72302ddb1add10141b154
1 /*
2 * linux/drivers/mtd/onenand/omap2.c
3 *
4 * OneNAND driver for OMAP2 / OMAP3
5 *
6 * Copyright © 2005-2006 Nokia Corporation
7 *
8 * Author: Jarkko Lavinen <jarkko.lavinen@nokia.com> and Juha Yrjölä
9 * IRQ and DMA support written by Timo Teras
10 *
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License version 2 as published by
13 * the Free Software Foundation.
14 *
15 * This program is distributed in the hope that it will be useful, but WITHOUT
16 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
17 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
18 * more details.
19 *
20 * You should have received a copy of the GNU General Public License along with
21 * this program; see the file COPYING. If not, write to the Free Software
22 * Foundation, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23 *
24 */
25
26 #include <linux/device.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/mtd/mtd.h>
30 #include <linux/mtd/onenand.h>
31 #include <linux/mtd/partitions.h>
32 #include <linux/platform_device.h>
33 #include <linux/interrupt.h>
34 #include <linux/delay.h>
35 #include <linux/dma-mapping.h>
36 #include <linux/io.h>
37 #include <linux/slab.h>
38 #include <linux/regulator/consumer.h>
39
40 #include <asm/mach/flash.h>
41 #include <linux/platform_data/mtd-onenand-omap2.h>
42 #include <asm/gpio.h>
43
44 #include <linux/omap-dma.h>
45
46 #define DRIVER_NAME "omap2-onenand"
47
48 #define ONENAND_BUFRAM_SIZE (1024 * 5)
49
50 struct omap2_onenand {
51 struct platform_device *pdev;
52 int gpmc_cs;
53 unsigned long phys_base;
54 unsigned int mem_size;
55 int gpio_irq;
56 struct mtd_info mtd;
57 struct onenand_chip onenand;
58 struct completion irq_done;
59 struct completion dma_done;
60 int dma_channel;
61 int freq;
62 int (*setup)(void __iomem *base, int *freq_ptr);
63 struct regulator *regulator;
64 u8 flags;
65 };
66
67 static void omap2_onenand_dma_cb(int lch, u16 ch_status, void *data)
68 {
69 struct omap2_onenand *c = data;
70
71 complete(&c->dma_done);
72 }
73
74 static irqreturn_t omap2_onenand_interrupt(int irq, void *dev_id)
75 {
76 struct omap2_onenand *c = dev_id;
77
78 complete(&c->irq_done);
79
80 return IRQ_HANDLED;
81 }
82
83 static inline unsigned short read_reg(struct omap2_onenand *c, int reg)
84 {
85 return readw(c->onenand.base + reg);
86 }
87
88 static inline void write_reg(struct omap2_onenand *c, unsigned short value,
89 int reg)
90 {
91 writew(value, c->onenand.base + reg);
92 }
93
94 static void wait_err(char *msg, int state, unsigned int ctrl, unsigned int intr)
95 {
96 printk(KERN_ERR "onenand_wait: %s! state %d ctrl 0x%04x intr 0x%04x\n",
97 msg, state, ctrl, intr);
98 }
99
100 static void wait_warn(char *msg, int state, unsigned int ctrl,
101 unsigned int intr)
102 {
103 printk(KERN_WARNING "onenand_wait: %s! state %d ctrl 0x%04x "
104 "intr 0x%04x\n", msg, state, ctrl, intr);
105 }
106
107 static int omap2_onenand_wait(struct mtd_info *mtd, int state)
108 {
109 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
110 struct onenand_chip *this = mtd->priv;
111 unsigned int intr = 0;
112 unsigned int ctrl, ctrl_mask;
113 unsigned long timeout;
114 u32 syscfg;
115
116 if (state == FL_RESETING || state == FL_PREPARING_ERASE ||
117 state == FL_VERIFYING_ERASE) {
118 int i = 21;
119 unsigned int intr_flags = ONENAND_INT_MASTER;
120
121 switch (state) {
122 case FL_RESETING:
123 intr_flags |= ONENAND_INT_RESET;
124 break;
125 case FL_PREPARING_ERASE:
126 intr_flags |= ONENAND_INT_ERASE;
127 break;
128 case FL_VERIFYING_ERASE:
129 i = 101;
130 break;
131 }
132
133 while (--i) {
134 udelay(1);
135 intr = read_reg(c, ONENAND_REG_INTERRUPT);
136 if (intr & ONENAND_INT_MASTER)
137 break;
138 }
139 ctrl = read_reg(c, ONENAND_REG_CTRL_STATUS);
140 if (ctrl & ONENAND_CTRL_ERROR) {
141 wait_err("controller error", state, ctrl, intr);
142 return -EIO;
143 }
144 if ((intr & intr_flags) == intr_flags)
145 return 0;
146 /* Continue in wait for interrupt branch */
147 }
148
149 if (state != FL_READING) {
150 int result;
151
152 /* Turn interrupts on */
153 syscfg = read_reg(c, ONENAND_REG_SYS_CFG1);
154 if (!(syscfg & ONENAND_SYS_CFG1_IOBE)) {
155 syscfg |= ONENAND_SYS_CFG1_IOBE;
156 write_reg(c, syscfg, ONENAND_REG_SYS_CFG1);
157 if (c->flags & ONENAND_IN_OMAP34XX)
158 /* Add a delay to let GPIO settle */
159 syscfg = read_reg(c, ONENAND_REG_SYS_CFG1);
160 }
161
162 reinit_completion(&c->irq_done);
163 if (c->gpio_irq) {
164 result = gpio_get_value(c->gpio_irq);
165 if (result == -1) {
166 ctrl = read_reg(c, ONENAND_REG_CTRL_STATUS);
167 intr = read_reg(c, ONENAND_REG_INTERRUPT);
168 wait_err("gpio error", state, ctrl, intr);
169 return -EIO;
170 }
171 } else
172 result = 0;
173 if (result == 0) {
174 int retry_cnt = 0;
175 retry:
176 result = wait_for_completion_timeout(&c->irq_done,
177 msecs_to_jiffies(20));
178 if (result == 0) {
179 /* Timeout after 20ms */
180 ctrl = read_reg(c, ONENAND_REG_CTRL_STATUS);
181 if (ctrl & ONENAND_CTRL_ONGO &&
182 !this->ongoing) {
183 /*
184 * The operation seems to be still going
185 * so give it some more time.
186 */
187 retry_cnt += 1;
188 if (retry_cnt < 3)
189 goto retry;
190 intr = read_reg(c,
191 ONENAND_REG_INTERRUPT);
192 wait_err("timeout", state, ctrl, intr);
193 return -EIO;
194 }
195 intr = read_reg(c, ONENAND_REG_INTERRUPT);
196 if ((intr & ONENAND_INT_MASTER) == 0)
197 wait_warn("timeout", state, ctrl, intr);
198 }
199 }
200 } else {
201 int retry_cnt = 0;
202
203 /* Turn interrupts off */
204 syscfg = read_reg(c, ONENAND_REG_SYS_CFG1);
205 syscfg &= ~ONENAND_SYS_CFG1_IOBE;
206 write_reg(c, syscfg, ONENAND_REG_SYS_CFG1);
207
208 timeout = jiffies + msecs_to_jiffies(20);
209 while (1) {
210 if (time_before(jiffies, timeout)) {
211 intr = read_reg(c, ONENAND_REG_INTERRUPT);
212 if (intr & ONENAND_INT_MASTER)
213 break;
214 } else {
215 /* Timeout after 20ms */
216 ctrl = read_reg(c, ONENAND_REG_CTRL_STATUS);
217 if (ctrl & ONENAND_CTRL_ONGO) {
218 /*
219 * The operation seems to be still going
220 * so give it some more time.
221 */
222 retry_cnt += 1;
223 if (retry_cnt < 3) {
224 timeout = jiffies +
225 msecs_to_jiffies(20);
226 continue;
227 }
228 }
229 break;
230 }
231 }
232 }
233
234 intr = read_reg(c, ONENAND_REG_INTERRUPT);
235 ctrl = read_reg(c, ONENAND_REG_CTRL_STATUS);
236
237 if (intr & ONENAND_INT_READ) {
238 int ecc = read_reg(c, ONENAND_REG_ECC_STATUS);
239
240 if (ecc) {
241 unsigned int addr1, addr8;
242
243 addr1 = read_reg(c, ONENAND_REG_START_ADDRESS1);
244 addr8 = read_reg(c, ONENAND_REG_START_ADDRESS8);
245 if (ecc & ONENAND_ECC_2BIT_ALL) {
246 printk(KERN_ERR "onenand_wait: ECC error = "
247 "0x%04x, addr1 %#x, addr8 %#x\n",
248 ecc, addr1, addr8);
249 mtd->ecc_stats.failed++;
250 return -EBADMSG;
251 } else if (ecc & ONENAND_ECC_1BIT_ALL) {
252 printk(KERN_NOTICE "onenand_wait: correctable "
253 "ECC error = 0x%04x, addr1 %#x, "
254 "addr8 %#x\n", ecc, addr1, addr8);
255 mtd->ecc_stats.corrected++;
256 }
257 }
258 } else if (state == FL_READING) {
259 wait_err("timeout", state, ctrl, intr);
260 return -EIO;
261 }
262
263 if (ctrl & ONENAND_CTRL_ERROR) {
264 wait_err("controller error", state, ctrl, intr);
265 if (ctrl & ONENAND_CTRL_LOCK)
266 printk(KERN_ERR "onenand_wait: "
267 "Device is write protected!!!\n");
268 return -EIO;
269 }
270
271 ctrl_mask = 0xFE9F;
272 if (this->ongoing)
273 ctrl_mask &= ~0x8000;
274
275 if (ctrl & ctrl_mask)
276 wait_warn("unexpected controller status", state, ctrl, intr);
277
278 return 0;
279 }
280
281 static inline int omap2_onenand_bufferram_offset(struct mtd_info *mtd, int area)
282 {
283 struct onenand_chip *this = mtd->priv;
284
285 if (ONENAND_CURRENT_BUFFERRAM(this)) {
286 if (area == ONENAND_DATARAM)
287 return this->writesize;
288 if (area == ONENAND_SPARERAM)
289 return mtd->oobsize;
290 }
291
292 return 0;
293 }
294
295 #if defined(CONFIG_ARCH_OMAP3) || defined(MULTI_OMAP2)
296
297 static int omap3_onenand_read_bufferram(struct mtd_info *mtd, int area,
298 unsigned char *buffer, int offset,
299 size_t count)
300 {
301 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
302 struct onenand_chip *this = mtd->priv;
303 dma_addr_t dma_src, dma_dst;
304 int bram_offset;
305 unsigned long timeout;
306 void *buf = (void *)buffer;
307 size_t xtra;
308 volatile unsigned *done;
309
310 bram_offset = omap2_onenand_bufferram_offset(mtd, area) + area + offset;
311 if (bram_offset & 3 || (size_t)buf & 3 || count < 384)
312 goto out_copy;
313
314 /* panic_write() may be in an interrupt context */
315 if (in_interrupt() || oops_in_progress)
316 goto out_copy;
317
318 if (buf >= high_memory) {
319 struct page *p1;
320
321 if (((size_t)buf & PAGE_MASK) !=
322 ((size_t)(buf + count - 1) & PAGE_MASK))
323 goto out_copy;
324 p1 = vmalloc_to_page(buf);
325 if (!p1)
326 goto out_copy;
327 buf = page_address(p1) + ((size_t)buf & ~PAGE_MASK);
328 }
329
330 xtra = count & 3;
331 if (xtra) {
332 count -= xtra;
333 memcpy(buf + count, this->base + bram_offset + count, xtra);
334 }
335
336 dma_src = c->phys_base + bram_offset;
337 dma_dst = dma_map_single(&c->pdev->dev, buf, count, DMA_FROM_DEVICE);
338 if (dma_mapping_error(&c->pdev->dev, dma_dst)) {
339 dev_err(&c->pdev->dev,
340 "Couldn't DMA map a %d byte buffer\n",
341 count);
342 goto out_copy;
343 }
344
345 omap_set_dma_transfer_params(c->dma_channel, OMAP_DMA_DATA_TYPE_S32,
346 count >> 2, 1, 0, 0, 0);
347 omap_set_dma_src_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
348 dma_src, 0, 0);
349 omap_set_dma_dest_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
350 dma_dst, 0, 0);
351
352 reinit_completion(&c->dma_done);
353 omap_start_dma(c->dma_channel);
354
355 timeout = jiffies + msecs_to_jiffies(20);
356 done = &c->dma_done.done;
357 while (time_before(jiffies, timeout))
358 if (*done)
359 break;
360
361 dma_unmap_single(&c->pdev->dev, dma_dst, count, DMA_FROM_DEVICE);
362
363 if (!*done) {
364 dev_err(&c->pdev->dev, "timeout waiting for DMA\n");
365 goto out_copy;
366 }
367
368 return 0;
369
370 out_copy:
371 memcpy(buf, this->base + bram_offset, count);
372 return 0;
373 }
374
375 static int omap3_onenand_write_bufferram(struct mtd_info *mtd, int area,
376 const unsigned char *buffer,
377 int offset, size_t count)
378 {
379 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
380 struct onenand_chip *this = mtd->priv;
381 dma_addr_t dma_src, dma_dst;
382 int bram_offset;
383 unsigned long timeout;
384 void *buf = (void *)buffer;
385 volatile unsigned *done;
386
387 bram_offset = omap2_onenand_bufferram_offset(mtd, area) + area + offset;
388 if (bram_offset & 3 || (size_t)buf & 3 || count < 384)
389 goto out_copy;
390
391 /* panic_write() may be in an interrupt context */
392 if (in_interrupt() || oops_in_progress)
393 goto out_copy;
394
395 if (buf >= high_memory) {
396 struct page *p1;
397
398 if (((size_t)buf & PAGE_MASK) !=
399 ((size_t)(buf + count - 1) & PAGE_MASK))
400 goto out_copy;
401 p1 = vmalloc_to_page(buf);
402 if (!p1)
403 goto out_copy;
404 buf = page_address(p1) + ((size_t)buf & ~PAGE_MASK);
405 }
406
407 dma_src = dma_map_single(&c->pdev->dev, buf, count, DMA_TO_DEVICE);
408 dma_dst = c->phys_base + bram_offset;
409 if (dma_mapping_error(&c->pdev->dev, dma_src)) {
410 dev_err(&c->pdev->dev,
411 "Couldn't DMA map a %d byte buffer\n",
412 count);
413 return -1;
414 }
415
416 omap_set_dma_transfer_params(c->dma_channel, OMAP_DMA_DATA_TYPE_S32,
417 count >> 2, 1, 0, 0, 0);
418 omap_set_dma_src_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
419 dma_src, 0, 0);
420 omap_set_dma_dest_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
421 dma_dst, 0, 0);
422
423 reinit_completion(&c->dma_done);
424 omap_start_dma(c->dma_channel);
425
426 timeout = jiffies + msecs_to_jiffies(20);
427 done = &c->dma_done.done;
428 while (time_before(jiffies, timeout))
429 if (*done)
430 break;
431
432 dma_unmap_single(&c->pdev->dev, dma_src, count, DMA_TO_DEVICE);
433
434 if (!*done) {
435 dev_err(&c->pdev->dev, "timeout waiting for DMA\n");
436 goto out_copy;
437 }
438
439 return 0;
440
441 out_copy:
442 memcpy(this->base + bram_offset, buf, count);
443 return 0;
444 }
445
446 #else
447
448 static int omap3_onenand_read_bufferram(struct mtd_info *mtd, int area,
449 unsigned char *buffer, int offset,
450 size_t count)
451 {
452 return -ENOSYS;
453 }
454
455 static int omap3_onenand_write_bufferram(struct mtd_info *mtd, int area,
456 const unsigned char *buffer,
457 int offset, size_t count)
458 {
459 return -ENOSYS;
460 }
461
462 #endif
463
464 #if defined(CONFIG_ARCH_OMAP2) || defined(MULTI_OMAP2)
465
466 static int omap2_onenand_read_bufferram(struct mtd_info *mtd, int area,
467 unsigned char *buffer, int offset,
468 size_t count)
469 {
470 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
471 struct onenand_chip *this = mtd->priv;
472 dma_addr_t dma_src, dma_dst;
473 int bram_offset;
474
475 bram_offset = omap2_onenand_bufferram_offset(mtd, area) + area + offset;
476 /* DMA is not used. Revisit PM requirements before enabling it. */
477 if (1 || (c->dma_channel < 0) ||
478 ((void *) buffer >= (void *) high_memory) || (bram_offset & 3) ||
479 (((unsigned int) buffer) & 3) || (count < 1024) || (count & 3)) {
480 memcpy(buffer, (__force void *)(this->base + bram_offset),
481 count);
482 return 0;
483 }
484
485 dma_src = c->phys_base + bram_offset;
486 dma_dst = dma_map_single(&c->pdev->dev, buffer, count,
487 DMA_FROM_DEVICE);
488 if (dma_mapping_error(&c->pdev->dev, dma_dst)) {
489 dev_err(&c->pdev->dev,
490 "Couldn't DMA map a %d byte buffer\n",
491 count);
492 return -1;
493 }
494
495 omap_set_dma_transfer_params(c->dma_channel, OMAP_DMA_DATA_TYPE_S32,
496 count / 4, 1, 0, 0, 0);
497 omap_set_dma_src_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
498 dma_src, 0, 0);
499 omap_set_dma_dest_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
500 dma_dst, 0, 0);
501
502 reinit_completion(&c->dma_done);
503 omap_start_dma(c->dma_channel);
504 wait_for_completion(&c->dma_done);
505
506 dma_unmap_single(&c->pdev->dev, dma_dst, count, DMA_FROM_DEVICE);
507
508 return 0;
509 }
510
511 static int omap2_onenand_write_bufferram(struct mtd_info *mtd, int area,
512 const unsigned char *buffer,
513 int offset, size_t count)
514 {
515 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
516 struct onenand_chip *this = mtd->priv;
517 dma_addr_t dma_src, dma_dst;
518 int bram_offset;
519
520 bram_offset = omap2_onenand_bufferram_offset(mtd, area) + area + offset;
521 /* DMA is not used. Revisit PM requirements before enabling it. */
522 if (1 || (c->dma_channel < 0) ||
523 ((void *) buffer >= (void *) high_memory) || (bram_offset & 3) ||
524 (((unsigned int) buffer) & 3) || (count < 1024) || (count & 3)) {
525 memcpy((__force void *)(this->base + bram_offset), buffer,
526 count);
527 return 0;
528 }
529
530 dma_src = dma_map_single(&c->pdev->dev, (void *) buffer, count,
531 DMA_TO_DEVICE);
532 dma_dst = c->phys_base + bram_offset;
533 if (dma_mapping_error(&c->pdev->dev, dma_src)) {
534 dev_err(&c->pdev->dev,
535 "Couldn't DMA map a %d byte buffer\n",
536 count);
537 return -1;
538 }
539
540 omap_set_dma_transfer_params(c->dma_channel, OMAP_DMA_DATA_TYPE_S16,
541 count / 2, 1, 0, 0, 0);
542 omap_set_dma_src_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
543 dma_src, 0, 0);
544 omap_set_dma_dest_params(c->dma_channel, 0, OMAP_DMA_AMODE_POST_INC,
545 dma_dst, 0, 0);
546
547 reinit_completion(&c->dma_done);
548 omap_start_dma(c->dma_channel);
549 wait_for_completion(&c->dma_done);
550
551 dma_unmap_single(&c->pdev->dev, dma_src, count, DMA_TO_DEVICE);
552
553 return 0;
554 }
555
556 #else
557
558 static int omap2_onenand_read_bufferram(struct mtd_info *mtd, int area,
559 unsigned char *buffer, int offset,
560 size_t count)
561 {
562 return -ENOSYS;
563 }
564
565 static int omap2_onenand_write_bufferram(struct mtd_info *mtd, int area,
566 const unsigned char *buffer,
567 int offset, size_t count)
568 {
569 return -ENOSYS;
570 }
571
572 #endif
573
574 static struct platform_driver omap2_onenand_driver;
575
576 static void omap2_onenand_shutdown(struct platform_device *pdev)
577 {
578 struct omap2_onenand *c = dev_get_drvdata(&pdev->dev);
579
580 /* With certain content in the buffer RAM, the OMAP boot ROM code
581 * can recognize the flash chip incorrectly. Zero it out before
582 * soft reset.
583 */
584 memset((__force void *)c->onenand.base, 0, ONENAND_BUFRAM_SIZE);
585 }
586
587 static int omap2_onenand_enable(struct mtd_info *mtd)
588 {
589 int ret;
590 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
591
592 ret = regulator_enable(c->regulator);
593 if (ret != 0)
594 dev_err(&c->pdev->dev, "can't enable regulator\n");
595
596 return ret;
597 }
598
599 static int omap2_onenand_disable(struct mtd_info *mtd)
600 {
601 int ret;
602 struct omap2_onenand *c = container_of(mtd, struct omap2_onenand, mtd);
603
604 ret = regulator_disable(c->regulator);
605 if (ret != 0)
606 dev_err(&c->pdev->dev, "can't disable regulator\n");
607
608 return ret;
609 }
610
611 static int omap2_onenand_probe(struct platform_device *pdev)
612 {
613 struct omap_onenand_platform_data *pdata;
614 struct omap2_onenand *c;
615 struct onenand_chip *this;
616 int r;
617 struct resource *res;
618 struct mtd_part_parser_data ppdata = {};
619
620 pdata = dev_get_platdata(&pdev->dev);
621 if (pdata == NULL) {
622 dev_err(&pdev->dev, "platform data missing\n");
623 return -ENODEV;
624 }
625
626 c = kzalloc(sizeof(struct omap2_onenand), GFP_KERNEL);
627 if (!c)
628 return -ENOMEM;
629
630 init_completion(&c->irq_done);
631 init_completion(&c->dma_done);
632 c->flags = pdata->flags;
633 c->gpmc_cs = pdata->cs;
634 c->gpio_irq = pdata->gpio_irq;
635 c->dma_channel = pdata->dma_channel;
636 if (c->dma_channel < 0) {
637 /* if -1, don't use DMA */
638 c->gpio_irq = 0;
639 }
640
641 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
642 if (res == NULL) {
643 r = -EINVAL;
644 dev_err(&pdev->dev, "error getting memory resource\n");
645 goto err_kfree;
646 }
647
648 c->phys_base = res->start;
649 c->mem_size = resource_size(res);
650
651 if (request_mem_region(c->phys_base, c->mem_size,
652 pdev->dev.driver->name) == NULL) {
653 dev_err(&pdev->dev, "Cannot reserve memory region at 0x%08lx, size: 0x%x\n",
654 c->phys_base, c->mem_size);
655 r = -EBUSY;
656 goto err_kfree;
657 }
658 c->onenand.base = ioremap(c->phys_base, c->mem_size);
659 if (c->onenand.base == NULL) {
660 r = -ENOMEM;
661 goto err_release_mem_region;
662 }
663
664 if (pdata->onenand_setup != NULL) {
665 r = pdata->onenand_setup(c->onenand.base, &c->freq);
666 if (r < 0) {
667 dev_err(&pdev->dev, "Onenand platform setup failed: "
668 "%d\n", r);
669 goto err_iounmap;
670 }
671 c->setup = pdata->onenand_setup;
672 }
673
674 if (c->gpio_irq) {
675 if ((r = gpio_request(c->gpio_irq, "OneNAND irq")) < 0) {
676 dev_err(&pdev->dev, "Failed to request GPIO%d for "
677 "OneNAND\n", c->gpio_irq);
678 goto err_iounmap;
679 }
680 gpio_direction_input(c->gpio_irq);
681
682 if ((r = request_irq(gpio_to_irq(c->gpio_irq),
683 omap2_onenand_interrupt, IRQF_TRIGGER_RISING,
684 pdev->dev.driver->name, c)) < 0)
685 goto err_release_gpio;
686 }
687
688 if (c->dma_channel >= 0) {
689 r = omap_request_dma(0, pdev->dev.driver->name,
690 omap2_onenand_dma_cb, (void *) c,
691 &c->dma_channel);
692 if (r == 0) {
693 omap_set_dma_write_mode(c->dma_channel,
694 OMAP_DMA_WRITE_NON_POSTED);
695 omap_set_dma_src_data_pack(c->dma_channel, 1);
696 omap_set_dma_src_burst_mode(c->dma_channel,
697 OMAP_DMA_DATA_BURST_8);
698 omap_set_dma_dest_data_pack(c->dma_channel, 1);
699 omap_set_dma_dest_burst_mode(c->dma_channel,
700 OMAP_DMA_DATA_BURST_8);
701 } else {
702 dev_info(&pdev->dev,
703 "failed to allocate DMA for OneNAND, "
704 "using PIO instead\n");
705 c->dma_channel = -1;
706 }
707 }
708
709 dev_info(&pdev->dev, "initializing on CS%d, phys base 0x%08lx, virtual "
710 "base %p, freq %d MHz\n", c->gpmc_cs, c->phys_base,
711 c->onenand.base, c->freq);
712
713 c->pdev = pdev;
714 c->mtd.name = dev_name(&pdev->dev);
715 c->mtd.priv = &c->onenand;
716 c->mtd.owner = THIS_MODULE;
717
718 c->mtd.dev.parent = &pdev->dev;
719
720 this = &c->onenand;
721 if (c->dma_channel >= 0) {
722 this->wait = omap2_onenand_wait;
723 if (c->flags & ONENAND_IN_OMAP34XX) {
724 this->read_bufferram = omap3_onenand_read_bufferram;
725 this->write_bufferram = omap3_onenand_write_bufferram;
726 } else {
727 this->read_bufferram = omap2_onenand_read_bufferram;
728 this->write_bufferram = omap2_onenand_write_bufferram;
729 }
730 }
731
732 if (pdata->regulator_can_sleep) {
733 c->regulator = regulator_get(&pdev->dev, "vonenand");
734 if (IS_ERR(c->regulator)) {
735 dev_err(&pdev->dev, "Failed to get regulator\n");
736 r = PTR_ERR(c->regulator);
737 goto err_release_dma;
738 }
739 c->onenand.enable = omap2_onenand_enable;
740 c->onenand.disable = omap2_onenand_disable;
741 }
742
743 if (pdata->skip_initial_unlocking)
744 this->options |= ONENAND_SKIP_INITIAL_UNLOCKING;
745
746 if ((r = onenand_scan(&c->mtd, 1)) < 0)
747 goto err_release_regulator;
748
749 ppdata.of_node = pdata->of_node;
750 r = mtd_device_parse_register(&c->mtd, NULL, &ppdata,
751 pdata ? pdata->parts : NULL,
752 pdata ? pdata->nr_parts : 0);
753 if (r)
754 goto err_release_onenand;
755
756 platform_set_drvdata(pdev, c);
757
758 return 0;
759
760 err_release_onenand:
761 onenand_release(&c->mtd);
762 err_release_regulator:
763 regulator_put(c->regulator);
764 err_release_dma:
765 if (c->dma_channel != -1)
766 omap_free_dma(c->dma_channel);
767 if (c->gpio_irq)
768 free_irq(gpio_to_irq(c->gpio_irq), c);
769 err_release_gpio:
770 if (c->gpio_irq)
771 gpio_free(c->gpio_irq);
772 err_iounmap:
773 iounmap(c->onenand.base);
774 err_release_mem_region:
775 release_mem_region(c->phys_base, c->mem_size);
776 err_kfree:
777 kfree(c);
778
779 return r;
780 }
781
782 static int omap2_onenand_remove(struct platform_device *pdev)
783 {
784 struct omap2_onenand *c = dev_get_drvdata(&pdev->dev);
785
786 onenand_release(&c->mtd);
787 regulator_put(c->regulator);
788 if (c->dma_channel != -1)
789 omap_free_dma(c->dma_channel);
790 omap2_onenand_shutdown(pdev);
791 if (c->gpio_irq) {
792 free_irq(gpio_to_irq(c->gpio_irq), c);
793 gpio_free(c->gpio_irq);
794 }
795 iounmap(c->onenand.base);
796 release_mem_region(c->phys_base, c->mem_size);
797 kfree(c);
798
799 return 0;
800 }
801
802 static struct platform_driver omap2_onenand_driver = {
803 .probe = omap2_onenand_probe,
804 .remove = omap2_onenand_remove,
805 .shutdown = omap2_onenand_shutdown,
806 .driver = {
807 .name = DRIVER_NAME,
808 .owner = THIS_MODULE,
809 },
810 };
811
812 module_platform_driver(omap2_onenand_driver);
813
814 MODULE_ALIAS("platform:" DRIVER_NAME);
815 MODULE_LICENSE("GPL");
816 MODULE_AUTHOR("Jarkko Lavinen <jarkko.lavinen@nokia.com>");
817 MODULE_DESCRIPTION("Glue layer for OneNAND flash on OMAP2 / OMAP3");
Linux with added FPC-III support