mxc_nand.c 22.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35
/*
 * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved.
 * Copyright 2008 Sascha Hauer, kernel@pengutronix.de
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
 * MA 02110-1301, USA.
 */

#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/nand.h>
#include <linux/mtd/partitions.h>
#include <linux/interrupt.h>
#include <linux/device.h>
#include <linux/platform_device.h>
#include <linux/clk.h>
#include <linux/err.h>
#include <linux/io.h>

#include <asm/mach/flash.h>
#include <mach/mxc_nand.h>
S
Sascha Hauer 已提交
36
#include <mach/hardware.h>
37 38 39

#define DRIVER_NAME "mxc_nand"

S
Sascha Hauer 已提交
40
#define nfc_is_v21()		(cpu_is_mx25() || cpu_is_mx35())
I
Ivo Clarysse 已提交
41
#define nfc_is_v1()		(cpu_is_mx31() || cpu_is_mx27() || cpu_is_mx21())
S
Sascha Hauer 已提交
42

43
/* Addresses for NFC registers */
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
#define NFC_BUF_SIZE			0x00
#define NFC_BUF_ADDR			0x04
#define NFC_FLASH_ADDR			0x06
#define NFC_FLASH_CMD			0x08
#define NFC_CONFIG			0x0a
#define NFC_ECC_STATUS_RESULT		0x0c
#define NFC_RSLTMAIN_AREA		0x0e
#define NFC_RSLTSPARE_AREA		0x10
#define NFC_WRPROT			0x12
#define NFC_V1_UNLOCKSTART_BLKADDR	0x14
#define NFC_V1_UNLOCKEND_BLKADDR	0x16
#define NFC_V21_UNLOCKSTART_BLKADDR	0x20
#define NFC_V21_UNLOCKEND_BLKADDR	0x22
#define NFC_NF_WRPRST			0x18
#define NFC_CONFIG1			0x1a
#define NFC_CONFIG2			0x1c
60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102

/* Set INT to 0, FCMD to 1, rest to 0 in NFC_CONFIG2 Register
 * for Command operation */
#define NFC_CMD            0x1

/* Set INT to 0, FADD to 1, rest to 0 in NFC_CONFIG2 Register
 * for Address operation */
#define NFC_ADDR           0x2

/* Set INT to 0, FDI to 1, rest to 0 in NFC_CONFIG2 Register
 * for Input operation */
#define NFC_INPUT          0x4

/* Set INT to 0, FDO to 001, rest to 0 in NFC_CONFIG2 Register
 * for Data Output operation */
#define NFC_OUTPUT         0x8

/* Set INT to 0, FD0 to 010, rest to 0 in NFC_CONFIG2 Register
 * for Read ID operation */
#define NFC_ID             0x10

/* Set INT to 0, FDO to 100, rest to 0 in NFC_CONFIG2 Register
 * for Read Status operation */
#define NFC_STATUS         0x20

/* Set INT to 1, rest to 0 in NFC_CONFIG2 Register for Read
 * Status operation */
#define NFC_INT            0x8000

#define NFC_SP_EN           (1 << 2)
#define NFC_ECC_EN          (1 << 3)
#define NFC_INT_MSK         (1 << 4)
#define NFC_BIG             (1 << 5)
#define NFC_RST             (1 << 6)
#define NFC_CE              (1 << 7)
#define NFC_ONE_CYCLE       (1 << 8)

struct mxc_nand_host {
	struct mtd_info		mtd;
	struct nand_chip	nand;
	struct mtd_partition	*parts;
	struct device		*dev;

103 104 105 106
	void			*spare0;
	void			*main_area0;

	void __iomem		*base;
107 108 109 110 111 112 113 114
	void __iomem		*regs;
	int			status_request;
	struct clk		*clk;
	int			clk_act;
	int			irq;

	wait_queue_head_t	irq_waitq;

S
Sascha Hauer 已提交
115 116 117
	uint8_t			*data_buf;
	unsigned int		buf_start;
	int			spare_len;
118 119 120 121 122 123 124

	void			(*preset)(struct mtd_info *);
	void			(*send_cmd)(struct mxc_nand_host *, uint16_t, int);
	void			(*send_addr)(struct mxc_nand_host *, uint16_t, int);
	void			(*send_page)(struct mtd_info *, unsigned int);
	void			(*send_read_id)(struct mxc_nand_host *);
	uint16_t		(*get_dev_status)(struct mxc_nand_host *);
125
	int			(*check_int)(struct mxc_nand_host *);
126 127 128
};

/* OOB placement block for use with hardware ecc generation */
S
Sascha Hauer 已提交
129
static struct nand_ecclayout nandv1_hw_eccoob_smallpage = {
130 131
	.eccbytes = 5,
	.eccpos = {6, 7, 8, 9, 10},
132
	.oobfree = {{0, 5}, {12, 4}, }
133 134
};

S
Sascha Hauer 已提交
135
static struct nand_ecclayout nandv1_hw_eccoob_largepage = {
136 137 138 139
	.eccbytes = 20,
	.eccpos = {6, 7, 8, 9, 10, 22, 23, 24, 25, 26,
		   38, 39, 40, 41, 42, 54, 55, 56, 57, 58},
	.oobfree = {{2, 4}, {11, 10}, {27, 10}, {43, 10}, {59, 5}, }
140 141
};

S
Sascha Hauer 已提交
142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169
/* OOB description for 512 byte pages with 16 byte OOB */
static struct nand_ecclayout nandv2_hw_eccoob_smallpage = {
	.eccbytes = 1 * 9,
	.eccpos = {
		 7,  8,  9, 10, 11, 12, 13, 14, 15
	},
	.oobfree = {
		{.offset = 0, .length = 5}
	}
};

/* OOB description for 2048 byte pages with 64 byte OOB */
static struct nand_ecclayout nandv2_hw_eccoob_largepage = {
	.eccbytes = 4 * 9,
	.eccpos = {
		 7,  8,  9, 10, 11, 12, 13, 14, 15,
		23, 24, 25, 26, 27, 28, 29, 30, 31,
		39, 40, 41, 42, 43, 44, 45, 46, 47,
		55, 56, 57, 58, 59, 60, 61, 62, 63
	},
	.oobfree = {
		{.offset = 2, .length = 4},
		{.offset = 16, .length = 7},
		{.offset = 32, .length = 7},
		{.offset = 48, .length = 7}
	}
};

170 171 172 173 174 175 176 177
#ifdef CONFIG_MTD_PARTITIONS
static const char *part_probes[] = { "RedBoot", "cmdlinepart", NULL };
#endif

static irqreturn_t mxc_nfc_irq(int irq, void *dev_id)
{
	struct mxc_nand_host *host = dev_id;

I
Ivo Clarysse 已提交
178
	disable_irq_nosync(irq);
179 180 181 182 183 184

	wake_up(&host->irq_waitq);

	return IRQ_HANDLED;
}

185 186 187 188 189 190 191 192 193 194 195 196 197
static int check_int_v1_v2(struct mxc_nand_host *host)
{
	uint32_t tmp;

	tmp = readw(host->regs + NFC_CONFIG2);
	if (!(tmp & NFC_INT))
		return 0;

	writew(tmp & ~NFC_INT, NFC_CONFIG2);

	return 1;
}

198 199 200
/* This function polls the NANDFC to wait for the basic operation to
 * complete by checking the INT bit of config2 register.
 */
S
Sascha Hauer 已提交
201
static void wait_op_done(struct mxc_nand_host *host, int useirq)
202
{
I
Ivo Clarysse 已提交
203
	int max_retries = 8000;
204 205

	if (useirq) {
206
		if (!host->check_int(host)) {
207

I
Ivo Clarysse 已提交
208
			enable_irq(host->irq);
209

210
			wait_event(host->irq_waitq, host->check_int(host));
211 212 213
		}
	} else {
		while (max_retries-- > 0) {
214
			if (host->check_int(host))
215
				break;
216

217 218
			udelay(1);
		}
219
		if (max_retries < 0)
S
Sascha Hauer 已提交
220 221
			DEBUG(MTD_DEBUG_LEVEL0, "%s: INT not set\n",
			      __func__);
222 223 224 225 226
	}
}

/* This function issues the specified command to the NAND device and
 * waits for completion. */
227
static void send_cmd_v1_v2(struct mxc_nand_host *host, uint16_t cmd, int useirq)
228 229 230 231 232 233
{
	DEBUG(MTD_DEBUG_LEVEL3, "send_cmd(host, 0x%x, %d)\n", cmd, useirq);

	writew(cmd, host->regs + NFC_FLASH_CMD);
	writew(NFC_CMD, host->regs + NFC_CONFIG2);

I
Ivo Clarysse 已提交
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250
	if (cpu_is_mx21() && (cmd == NAND_CMD_RESET)) {
		int max_retries = 100;
		/* Reset completion is indicated by NFC_CONFIG2 */
		/* being set to 0 */
		while (max_retries-- > 0) {
			if (readw(host->regs + NFC_CONFIG2) == 0) {
				break;
			}
			udelay(1);
		}
		if (max_retries < 0)
			DEBUG(MTD_DEBUG_LEVEL0, "%s: RESET failed\n",
			      __func__);
	} else {
		/* Wait for operation to complete */
		wait_op_done(host, useirq);
	}
251 252 253 254 255
}

/* This function sends an address (or partial address) to the
 * NAND device. The address is used to select the source/destination for
 * a NAND command. */
256
static void send_addr_v1_v2(struct mxc_nand_host *host, uint16_t addr, int islast)
257 258 259 260 261 262 263
{
	DEBUG(MTD_DEBUG_LEVEL3, "send_addr(host, 0x%x %d)\n", addr, islast);

	writew(addr, host->regs + NFC_FLASH_ADDR);
	writew(NFC_ADDR, host->regs + NFC_CONFIG2);

	/* Wait for operation to complete */
S
Sascha Hauer 已提交
264
	wait_op_done(host, islast);
265 266
}

267
static void send_page_v1_v2(struct mtd_info *mtd, unsigned int ops)
268
{
269 270
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
271
	int bufs, i;
272

S
Sascha Hauer 已提交
273
	if (nfc_is_v1() && mtd->writesize > 512)
274 275 276
		bufs = 4;
	else
		bufs = 1;
277

278
	for (i = 0; i < bufs; i++) {
279

280 281
		/* NANDFC buffer 0 is used for page read/write */
		writew(i, host->regs + NFC_BUF_ADDR);
282

283
		writew(ops, host->regs + NFC_CONFIG2);
284

285
		/* Wait for operation to complete */
S
Sascha Hauer 已提交
286
		wait_op_done(host, true);
287 288 289 290
	}
}

/* Request the NANDFC to perform a read of the NAND device ID. */
291
static void send_read_id_v1_v2(struct mxc_nand_host *host)
292 293 294 295 296 297 298 299 300
{
	struct nand_chip *this = &host->nand;

	/* NANDFC buffer 0 is used for device ID output */
	writew(0x0, host->regs + NFC_BUF_ADDR);

	writew(NFC_ID, host->regs + NFC_CONFIG2);

	/* Wait for operation to complete */
S
Sascha Hauer 已提交
301
	wait_op_done(host, true);
302 303

	if (this->options & NAND_BUSWIDTH_16) {
304
		void __iomem *main_buf = host->main_area0;
305 306 307 308 309 310 311
		/* compress the ID info */
		writeb(readb(main_buf + 2), main_buf + 1);
		writeb(readb(main_buf + 4), main_buf + 2);
		writeb(readb(main_buf + 6), main_buf + 3);
		writeb(readb(main_buf + 8), main_buf + 4);
		writeb(readb(main_buf + 10), main_buf + 5);
	}
312
	memcpy(host->data_buf, host->main_area0, 16);
313 314 315 316
}

/* This function requests the NANDFC to perform a read of the
 * NAND device status and returns the current status. */
317
static uint16_t get_dev_status_v1_v2(struct mxc_nand_host *host)
318
{
S
Sascha Hauer 已提交
319
	void __iomem *main_buf = host->main_area0;
320
	uint32_t store;
321
	uint16_t ret;
322

S
Sascha Hauer 已提交
323 324 325 326 327 328 329
	writew(0x0, NFC_V1_V2_BUF_ADDR);

	/*
	 * The device status is stored in main_area0. To
	 * prevent corruption of the buffer save the value
	 * and restore it afterwards.
	 */
330 331 332
	store = readl(main_buf);

	writew(NFC_STATUS, host->regs + NFC_CONFIG2);
S
Sascha Hauer 已提交
333
	wait_op_done(host, true);
334 335

	ret = readw(main_buf);
S
Sascha Hauer 已提交
336

337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391
	writel(store, main_buf);

	return ret;
}

/* This functions is used by upper layer to checks if device is ready */
static int mxc_nand_dev_ready(struct mtd_info *mtd)
{
	/*
	 * NFC handles R/B internally. Therefore, this function
	 * always returns status as ready.
	 */
	return 1;
}

static void mxc_nand_enable_hwecc(struct mtd_info *mtd, int mode)
{
	/*
	 * If HW ECC is enabled, we turn it on during init. There is
	 * no need to enable again here.
	 */
}

static int mxc_nand_correct_data(struct mtd_info *mtd, u_char *dat,
				 u_char *read_ecc, u_char *calc_ecc)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;

	/*
	 * 1-Bit errors are automatically corrected in HW.  No need for
	 * additional correction.  2-Bit errors cannot be corrected by
	 * HW ECC, so we need to return failure
	 */
	uint16_t ecc_status = readw(host->regs + NFC_ECC_STATUS_RESULT);

	if (((ecc_status & 0x3) == 2) || ((ecc_status >> 2) == 2)) {
		DEBUG(MTD_DEBUG_LEVEL0,
		      "MXC_NAND: HWECC uncorrectable 2-bit ECC error\n");
		return -1;
	}

	return 0;
}

static int mxc_nand_calculate_ecc(struct mtd_info *mtd, const u_char *dat,
				  u_char *ecc_code)
{
	return 0;
}

static u_char mxc_nand_read_byte(struct mtd_info *mtd)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
S
Sascha Hauer 已提交
392
	uint8_t ret;
393 394 395

	/* Check for status request */
	if (host->status_request)
396
		return host->get_dev_status(host) & 0xFF;
397

S
Sascha Hauer 已提交
398 399
	ret = *(uint8_t *)(host->data_buf + host->buf_start);
	host->buf_start++;
400 401 402 403 404 405 406 407

	return ret;
}

static uint16_t mxc_nand_read_word(struct mtd_info *mtd)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
S
Sascha Hauer 已提交
408
	uint16_t ret;
409

S
Sascha Hauer 已提交
410 411
	ret = *(uint16_t *)(host->data_buf + host->buf_start);
	host->buf_start += 2;
412 413 414 415 416 417 418 419 420 421 422 423

	return ret;
}

/* Write data of length len to buffer buf. The data to be
 * written on NAND Flash is first copied to RAMbuffer. After the Data Input
 * Operation by the NFC, the data is written to NAND Flash */
static void mxc_nand_write_buf(struct mtd_info *mtd,
				const u_char *buf, int len)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
S
Sascha Hauer 已提交
424 425
	u16 col = host->buf_start;
	int n = mtd->oobsize + mtd->writesize - col;
426

S
Sascha Hauer 已提交
427
	n = min(n, len);
428

S
Sascha Hauer 已提交
429
	memcpy(host->data_buf + col, buf, n);
430

S
Sascha Hauer 已提交
431
	host->buf_start += n;
432 433 434 435 436 437 438 439 440 441
}

/* Read the data buffer from the NAND Flash. To read the data from NAND
 * Flash first the data output cycle is initiated by the NFC, which copies
 * the data to RAMbuffer. This data of length len is then copied to buffer buf.
 */
static void mxc_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
S
Sascha Hauer 已提交
442 443
	u16 col = host->buf_start;
	int n = mtd->oobsize + mtd->writesize - col;
444

S
Sascha Hauer 已提交
445
	n = min(n, len);
446

S
Sascha Hauer 已提交
447
	memcpy(buf, host->data_buf + col, len);
448

S
Sascha Hauer 已提交
449
	host->buf_start += len;
450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487
}

/* Used by the upper layer to verify the data in NAND Flash
 * with the data in the buf. */
static int mxc_nand_verify_buf(struct mtd_info *mtd,
				const u_char *buf, int len)
{
	return -EFAULT;
}

/* This function is used by upper layer for select and
 * deselect of the NAND chip */
static void mxc_nand_select_chip(struct mtd_info *mtd, int chip)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;

	switch (chip) {
	case -1:
		/* Disable the NFC clock */
		if (host->clk_act) {
			clk_disable(host->clk);
			host->clk_act = 0;
		}
		break;
	case 0:
		/* Enable the NFC clock */
		if (!host->clk_act) {
			clk_enable(host->clk);
			host->clk_act = 1;
		}
		break;

	default:
		break;
	}
}

S
Sascha Hauer 已提交
488 489 490 491
/*
 * Function to transfer data to/from spare area.
 */
static void copy_spare(struct mtd_info *mtd, bool bfrom)
492
{
S
Sascha Hauer 已提交
493 494 495 496 497
	struct nand_chip *this = mtd->priv;
	struct mxc_nand_host *host = this->priv;
	u16 i, j;
	u16 n = mtd->writesize >> 9;
	u8 *d = host->data_buf + mtd->writesize;
498
	u8 *s = host->spare0;
S
Sascha Hauer 已提交
499 500 501 502 503 504 505 506 507 508 509 510 511
	u16 t = host->spare_len;

	j = (mtd->oobsize / n >> 1) << 1;

	if (bfrom) {
		for (i = 0; i < n - 1; i++)
			memcpy(d + i * j, s + i * t, j);

		/* the last section */
		memcpy(d + i * j, s + i * t, mtd->oobsize - i * j);
	} else {
		for (i = 0; i < n - 1; i++)
			memcpy(&s[i * t], &d[i * j], j);
512

S
Sascha Hauer 已提交
513 514
		/* the last section */
		memcpy(&s[i * t], &d[i * j], mtd->oobsize - i * j);
515
	}
S
Sascha Hauer 已提交
516
}
517

518 519 520 521
static void mxc_do_addr_cycle(struct mtd_info *mtd, int column, int page_addr)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
522 523 524 525 526 527 528

	/* Write out column address, if necessary */
	if (column != -1) {
		/*
		 * MXC NANDFC can only perform full page+spare or
		 * spare-only read/write.  When the upper layers
		 * layers perform a read/write buf operation,
D
Daniel Mack 已提交
529
		 * we will used the saved column address to index into
530 531
		 * the full page.
		 */
532
		host->send_addr(host, 0, page_addr == -1);
533
		if (mtd->writesize > 512)
534
			/* another col addr cycle for 2k page */
535
			host->send_addr(host, 0, false);
536 537 538 539 540
	}

	/* Write out page address, if necessary */
	if (page_addr != -1) {
		/* paddr_0 - p_addr_7 */
541
		host->send_addr(host, (page_addr & 0xff), false);
542

543
		if (mtd->writesize > 512) {
544 545
			if (mtd->size >= 0x10000000) {
				/* paddr_8 - paddr_15 */
546 547
				host->send_addr(host, (page_addr >> 8) & 0xff, false);
				host->send_addr(host, (page_addr >> 16) & 0xff, true);
548 549
			} else
				/* paddr_8 - paddr_15 */
550
				host->send_addr(host, (page_addr >> 8) & 0xff, true);
551 552 553 554
		} else {
			/* One more address cycle for higher density devices */
			if (mtd->size >= 0x4000000) {
				/* paddr_8 - paddr_15 */
555 556
				host->send_addr(host, (page_addr >> 8) & 0xff, false);
				host->send_addr(host, (page_addr >> 16) & 0xff, true);
557 558
			} else
				/* paddr_8 - paddr_15 */
559
				host->send_addr(host, (page_addr >> 8) & 0xff, true);
560 561
		}
	}
562 563
}

564
static void preset_v1_v2(struct mtd_info *mtd)
565 566 567 568 569
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
	uint16_t tmp;

I
Ivo Clarysse 已提交
570
	/* enable interrupt, disable spare enable */
571
	tmp = readw(host->regs + NFC_CONFIG1);
I
Ivo Clarysse 已提交
572
	tmp &= ~NFC_INT_MSK;
573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598
	tmp &= ~NFC_SP_EN;
	if (nand_chip->ecc.mode == NAND_ECC_HW) {
		tmp |= NFC_ECC_EN;
	} else {
		tmp &= ~NFC_ECC_EN;
	}
	writew(tmp, host->regs + NFC_CONFIG1);
	/* preset operation */

	/* Unlock the internal RAM Buffer */
	writew(0x2, host->regs + NFC_CONFIG);

	/* Blocks to be unlocked */
	if (nfc_is_v21()) {
		writew(0x0, host->regs + NFC_V21_UNLOCKSTART_BLKADDR);
		writew(0xffff, host->regs + NFC_V21_UNLOCKEND_BLKADDR);
	} else if (nfc_is_v1()) {
		writew(0x0, host->regs + NFC_V1_UNLOCKSTART_BLKADDR);
		writew(0x4000, host->regs + NFC_V1_UNLOCKEND_BLKADDR);
	} else
		BUG();

	/* Unlock Block Command for given address range */
	writew(0x4, host->regs + NFC_WRPROT);
}

599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615
/* Used by the upper layer to write command to NAND Flash for
 * different operations to be carried out on NAND Flash */
static void mxc_nand_command(struct mtd_info *mtd, unsigned command,
				int column, int page_addr)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;

	DEBUG(MTD_DEBUG_LEVEL3,
	      "mxc_nand_command (cmd = 0x%x, col = 0x%x, page = 0x%x)\n",
	      command, column, page_addr);

	/* Reset command state information */
	host->status_request = false;

	/* Command pre-processing step */
	switch (command) {
616
	case NAND_CMD_RESET:
617 618
		host->preset(mtd);
		host->send_cmd(host, command, false);
619
		break;
620 621

	case NAND_CMD_STATUS:
S
Sascha Hauer 已提交
622
		host->buf_start = 0;
623 624
		host->status_request = true;

625
		host->send_cmd(host, command, true);
626
		mxc_do_addr_cycle(mtd, column, page_addr);
627 628 629 630
		break;

	case NAND_CMD_READ0:
	case NAND_CMD_READOOB:
631 632 633 634
		if (command == NAND_CMD_READ0)
			host->buf_start = column;
		else
			host->buf_start = column + mtd->writesize;
S
Sascha Hauer 已提交
635

636
		command = NAND_CMD_READ0; /* only READ0 is valid */
637

638
		host->send_cmd(host, command, false);
639 640
		mxc_do_addr_cycle(mtd, column, page_addr);

641
		if (mtd->writesize > 512)
642
			host->send_cmd(host, NAND_CMD_READSTART, true);
643

644
		host->send_page(mtd, NFC_OUTPUT);
645

646
		memcpy(host->data_buf, host->main_area0, mtd->writesize);
647
		copy_spare(mtd, true);
648 649 650
		break;

	case NAND_CMD_SEQIN:
651 652 653
		if (column >= mtd->writesize)
			/* call ourself to read a page */
			mxc_nand_command(mtd, NAND_CMD_READ0, 0, page_addr);
654

655
		host->buf_start = column;
656

657
		host->send_cmd(host, command, false);
658
		mxc_do_addr_cycle(mtd, column, page_addr);
659 660 661
		break;

	case NAND_CMD_PAGEPROG:
662
		memcpy(host->main_area0, host->data_buf, mtd->writesize);
S
Sascha Hauer 已提交
663
		copy_spare(mtd, false);
664 665
		host->send_page(mtd, NFC_INPUT);
		host->send_cmd(host, command, true);
666
		mxc_do_addr_cycle(mtd, column, page_addr);
667 668 669
		break;

	case NAND_CMD_READID:
670
		host->send_cmd(host, command, true);
671
		mxc_do_addr_cycle(mtd, column, page_addr);
672
		host->send_read_id(host);
S
Sascha Hauer 已提交
673
		host->buf_start = column;
674 675
		break;

676
	case NAND_CMD_ERASE1:
677
	case NAND_CMD_ERASE2:
678
		host->send_cmd(host, command, false);
679 680
		mxc_do_addr_cycle(mtd, column, page_addr);

681 682 683 684
		break;
	}
}

S
Sascha Hauer 已提交
685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711
/*
 * The generic flash bbt decriptors overlap with our ecc
 * hardware, so define some i.MX specific ones.
 */
static uint8_t bbt_pattern[] = { 'B', 'b', 't', '0' };
static uint8_t mirror_pattern[] = { '1', 't', 'b', 'B' };

static struct nand_bbt_descr bbt_main_descr = {
	.options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE
	    | NAND_BBT_2BIT | NAND_BBT_VERSION | NAND_BBT_PERCHIP,
	.offs = 0,
	.len = 4,
	.veroffs = 4,
	.maxblocks = 4,
	.pattern = bbt_pattern,
};

static struct nand_bbt_descr bbt_mirror_descr = {
	.options = NAND_BBT_LASTBLOCK | NAND_BBT_CREATE | NAND_BBT_WRITE
	    | NAND_BBT_2BIT | NAND_BBT_VERSION | NAND_BBT_PERCHIP,
	.offs = 0,
	.len = 4,
	.veroffs = 4,
	.maxblocks = 4,
	.pattern = mirror_pattern,
};

712 713 714 715 716 717 718 719
static int __init mxcnd_probe(struct platform_device *pdev)
{
	struct nand_chip *this;
	struct mtd_info *mtd;
	struct mxc_nand_platform_data *pdata = pdev->dev.platform_data;
	struct mxc_nand_host *host;
	struct resource *res;
	int err = 0, nr_parts = 0;
S
Sascha Hauer 已提交
720
	struct nand_ecclayout *oob_smallpage, *oob_largepage;
721 722

	/* Allocate memory for MTD device structure and private data */
S
Sascha Hauer 已提交
723 724
	host = kzalloc(sizeof(struct mxc_nand_host) + NAND_MAX_PAGESIZE +
			NAND_MAX_OOBSIZE, GFP_KERNEL);
725 726 727
	if (!host)
		return -ENOMEM;

S
Sascha Hauer 已提交
728 729
	host->data_buf = (uint8_t *)(host + 1);

730 731 732 733 734 735
	host->dev = &pdev->dev;
	/* structures must be linked */
	this = &host->nand;
	mtd = &host->mtd;
	mtd->priv = this;
	mtd->owner = THIS_MODULE;
736
	mtd->dev.parent = &pdev->dev;
737
	mtd->name = DRIVER_NAME;
738 739 740 741 742 743 744 745 746 747 748 749 750 751

	/* 50 us command delay time */
	this->chip_delay = 5;

	this->priv = host;
	this->dev_ready = mxc_nand_dev_ready;
	this->cmdfunc = mxc_nand_command;
	this->select_chip = mxc_nand_select_chip;
	this->read_byte = mxc_nand_read_byte;
	this->read_word = mxc_nand_read_word;
	this->write_buf = mxc_nand_write_buf;
	this->read_buf = mxc_nand_read_buf;
	this->verify_buf = mxc_nand_verify_buf;

752
	host->clk = clk_get(&pdev->dev, "nfc");
753 754
	if (IS_ERR(host->clk)) {
		err = PTR_ERR(host->clk);
755
		goto eclk;
756
	}
757 758 759 760 761 762 763 764 765 766

	clk_enable(host->clk);
	host->clk_act = 1;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		err = -ENODEV;
		goto eres;
	}

767 768
	host->base = ioremap(res->start, resource_size(res));
	if (!host->base) {
769
		err = -ENOMEM;
770 771 772
		goto eres;
	}

773
	host->main_area0 = host->base;
S
Sascha Hauer 已提交
774

775 776 777 778 779 780 781
	if (nfc_is_v1() || nfc_is_v21()) {
		host->preset = preset_v1_v2;
		host->send_cmd = send_cmd_v1_v2;
		host->send_addr = send_addr_v1_v2;
		host->send_page = send_page_v1_v2;
		host->send_read_id = send_read_id_v1_v2;
		host->get_dev_status = get_dev_status_v1_v2;
782
		host->check_int = check_int_v1_v2;
783 784
	}

S
Sascha Hauer 已提交
785
	if (nfc_is_v21()) {
786
		host->regs = host->base + 0x1e00;
S
Sascha Hauer 已提交
787 788 789 790
		host->spare0 = host->base + 0x1000;
		host->spare_len = 64;
		oob_smallpage = &nandv2_hw_eccoob_smallpage;
		oob_largepage = &nandv2_hw_eccoob_largepage;
791
		this->ecc.bytes = 9;
S
Sascha Hauer 已提交
792
	} else if (nfc_is_v1()) {
793
		host->regs = host->base + 0xe00;
S
Sascha Hauer 已提交
794 795 796 797 798 799 800
		host->spare0 = host->base + 0x800;
		host->spare_len = 16;
		oob_smallpage = &nandv1_hw_eccoob_smallpage;
		oob_largepage = &nandv1_hw_eccoob_largepage;
		this->ecc.bytes = 3;
	} else
		BUG();
S
Sascha Hauer 已提交
801 802

	this->ecc.size = 512;
S
Sascha Hauer 已提交
803
	this->ecc.layout = oob_smallpage;
S
Sascha Hauer 已提交
804

805 806 807 808 809 810 811 812 813 814
	if (pdata->hw_ecc) {
		this->ecc.calculate = mxc_nand_calculate_ecc;
		this->ecc.hwctl = mxc_nand_enable_hwecc;
		this->ecc.correct = mxc_nand_correct_data;
		this->ecc.mode = NAND_ECC_HW;
	} else {
		this->ecc.mode = NAND_ECC_SOFT;
	}

	/* NAND bus width determines access funtions used by upper layer */
S
Sascha Hauer 已提交
815
	if (pdata->width == 2)
816 817
		this->options |= NAND_BUSWIDTH_16;

S
Sascha Hauer 已提交
818 819 820 821 822
	if (pdata->flash_bbt) {
		this->bbt_td = &bbt_main_descr;
		this->bbt_md = &bbt_mirror_descr;
		/* update flash based bbt */
		this->options |= NAND_USE_FLASH_BBT;
823 824
	}

825 826 827 828
	init_waitqueue_head(&host->irq_waitq);

	host->irq = platform_get_irq(pdev, 0);

I
Ivo Clarysse 已提交
829
	err = request_irq(host->irq, mxc_nfc_irq, IRQF_DISABLED, DRIVER_NAME, host);
830 831 832
	if (err)
		goto eirq;

833
	/* first scan to find the device and get the page size */
834
	if (nand_scan_ident(mtd, 1, NULL)) {
835 836 837
		err = -ENXIO;
		goto escan;
	}
838

839
	if (mtd->writesize == 2048)
S
Sascha Hauer 已提交
840
		this->ecc.layout = oob_largepage;
841 842 843

	/* second phase scan */
	if (nand_scan_tail(mtd)) {
844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865
		err = -ENXIO;
		goto escan;
	}

	/* Register the partitions */
#ifdef CONFIG_MTD_PARTITIONS
	nr_parts =
	    parse_mtd_partitions(mtd, part_probes, &host->parts, 0);
	if (nr_parts > 0)
		add_mtd_partitions(mtd, host->parts, nr_parts);
	else
#endif
	{
		pr_info("Registering %s as whole device\n", mtd->name);
		add_mtd_device(mtd);
	}

	platform_set_drvdata(pdev, host);

	return 0;

escan:
866
	free_irq(host->irq, host);
867
eirq:
868
	iounmap(host->base);
869 870 871 872 873 874 875 876
eres:
	clk_put(host->clk);
eclk:
	kfree(host);

	return err;
}

877
static int __devexit mxcnd_remove(struct platform_device *pdev)
878 879 880 881 882 883 884 885
{
	struct mxc_nand_host *host = platform_get_drvdata(pdev);

	clk_put(host->clk);

	platform_set_drvdata(pdev, NULL);

	nand_release(&host->mtd);
886
	free_irq(host->irq, host);
887
	iounmap(host->base);
888 889 890 891 892 893 894 895
	kfree(host);

	return 0;
}

static struct platform_driver mxcnd_driver = {
	.driver = {
		   .name = DRIVER_NAME,
896
	},
897
	.remove = __devexit_p(mxcnd_remove),
898 899 900 901
};

static int __init mxc_nd_init(void)
{
902
	return platform_driver_probe(&mxcnd_driver, mxcnd_probe);
903 904 905 906 907 908 909 910 911 912 913 914 915 916
}

static void __exit mxc_nd_cleanup(void)
{
	/* Unregister the device structure */
	platform_driver_unregister(&mxcnd_driver);
}

module_init(mxc_nd_init);
module_exit(mxc_nd_cleanup);

MODULE_AUTHOR("Freescale Semiconductor, Inc.");
MODULE_DESCRIPTION("MXC NAND MTD driver");
MODULE_LICENSE("GPL");