Linux Audio

Check our new training course

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