mxc_nand.c 23.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 44 45 46 47 48 49 50 51 52
/* Addresses for NFC registers */
#define NFC_BUF_SIZE		0xE00
#define NFC_BUF_ADDR		0xE04
#define NFC_FLASH_ADDR		0xE06
#define NFC_FLASH_CMD		0xE08
#define NFC_CONFIG		0xE0A
#define NFC_ECC_STATUS_RESULT	0xE0C
#define NFC_RSLTMAIN_AREA	0xE0E
#define NFC_RSLTSPARE_AREA	0xE10
#define NFC_WRPROT		0xE12
S
Sascha Hauer 已提交
53 54 55 56
#define NFC_V1_UNLOCKSTART_BLKADDR	0xe14
#define NFC_V1_UNLOCKEND_BLKADDR	0xe16
#define NFC_V21_UNLOCKSTART_BLKADDR	0xe20
#define NFC_V21_UNLOCKEND_BLKADDR	0xe22
57 58 59 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
#define NFC_NF_WRPRST		0xE18
#define NFC_CONFIG1		0xE1A
#define NFC_CONFIG2		0xE1C

/* 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 107
	void			*spare0;
	void			*main_area0;
	void			*main_area1;

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

	wait_queue_head_t	irq_waitq;

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

/* OOB placement block for use with hardware ecc generation */
S
Sascha Hauer 已提交
122
static struct nand_ecclayout nandv1_hw_eccoob_smallpage = {
123 124
	.eccbytes = 5,
	.eccpos = {6, 7, 8, 9, 10},
125
	.oobfree = {{0, 5}, {12, 4}, }
126 127
};

S
Sascha Hauer 已提交
128
static struct nand_ecclayout nandv1_hw_eccoob_largepage = {
129 130 131 132
	.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}, }
133 134
};

S
Sascha Hauer 已提交
135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162
/* 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}
	}
};

163 164 165 166 167 168 169 170
#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 已提交
171
	disable_irq_nosync(irq);
172 173 174 175 176 177 178 179 180

	wake_up(&host->irq_waitq);

	return IRQ_HANDLED;
}

/* This function polls the NANDFC to wait for the basic operation to
 * complete by checking the INT bit of config2 register.
 */
S
Sascha Hauer 已提交
181
static void wait_op_done(struct mxc_nand_host *host, int useirq)
182
{
I
Ivo Clarysse 已提交
183 184
	uint16_t tmp;
	int max_retries = 8000;
185 186 187 188

	if (useirq) {
		if ((readw(host->regs + NFC_CONFIG2) & NFC_INT) == 0) {

I
Ivo Clarysse 已提交
189
			enable_irq(host->irq);
190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207

			wait_event(host->irq_waitq,
				readw(host->regs + NFC_CONFIG2) & NFC_INT);

			tmp = readw(host->regs + NFC_CONFIG2);
			tmp  &= ~NFC_INT;
			writew(tmp, host->regs + NFC_CONFIG2);
		}
	} else {
		while (max_retries-- > 0) {
			if (readw(host->regs + NFC_CONFIG2) & NFC_INT) {
				tmp = readw(host->regs + NFC_CONFIG2);
				tmp  &= ~NFC_INT;
				writew(tmp, host->regs + NFC_CONFIG2);
				break;
			}
			udelay(1);
		}
208
		if (max_retries < 0)
S
Sascha Hauer 已提交
209 210
			DEBUG(MTD_DEBUG_LEVEL0, "%s: INT not set\n",
			      __func__);
211 212 213 214 215 216 217 218 219 220 221 222
	}
}

/* This function issues the specified command to the NAND device and
 * waits for completion. */
static void send_cmd(struct mxc_nand_host *host, uint16_t cmd, int useirq)
{
	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 已提交
223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
	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);
	}
240 241 242 243 244 245 246 247 248 249 250 251 252
}

/* 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. */
static void send_addr(struct mxc_nand_host *host, uint16_t addr, int islast)
{
	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 已提交
253
	wait_op_done(host, islast);
254 255
}

256
static void send_page(struct mtd_info *mtd, unsigned int ops)
257
{
258 259
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
260
	int bufs, i;
261

S
Sascha Hauer 已提交
262
	if (nfc_is_v1() && mtd->writesize > 512)
263 264 265
		bufs = 4;
	else
		bufs = 1;
266

267
	for (i = 0; i < bufs; i++) {
268

269 270
		/* NANDFC buffer 0 is used for page read/write */
		writew(i, host->regs + NFC_BUF_ADDR);
271

272
		writew(ops, host->regs + NFC_CONFIG2);
273

274
		/* Wait for operation to complete */
S
Sascha Hauer 已提交
275
		wait_op_done(host, true);
276 277 278 279 280 281 282 283 284 285 286 287 288 289
	}
}

/* Request the NANDFC to perform a read of the NAND device ID. */
static void send_read_id(struct mxc_nand_host *host)
{
	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 已提交
290
	wait_op_done(host, true);
291 292

	if (this->options & NAND_BUSWIDTH_16) {
293
		void __iomem *main_buf = host->main_area0;
294 295 296 297 298 299 300
		/* 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);
	}
301
	memcpy(host->data_buf, host->main_area0, 16);
302 303 304 305 306 307
}

/* This function requests the NANDFC to perform a read of the
 * NAND device status and returns the current status. */
static uint16_t get_dev_status(struct mxc_nand_host *host)
{
308
	void __iomem *main_buf = host->main_area1;
309
	uint32_t store;
310
	uint16_t ret;
311 312 313 314 315 316 317 318 319 320 321
	/* Issue status request to NAND device */

	/* store the main area1 first word, later do recovery */
	store = readl(main_buf);
	/* NANDFC buffer 1 is used for device status to prevent
	 * corruption of read/write buffer on status requests. */
	writew(1, host->regs + NFC_BUF_ADDR);

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

	/* Wait for operation to complete */
S
Sascha Hauer 已提交
322
	wait_op_done(host, true);
323 324 325 326 327 328 329 330 331 332 333 334 335 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

	/* Status is placed in first word of main buffer */
	/* get status, then recovery area 1 data */
	ret = readw(main_buf);
	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 已提交
382
	uint8_t ret;
383 384 385 386 387

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

S
Sascha Hauer 已提交
388 389
	ret = *(uint8_t *)(host->data_buf + host->buf_start);
	host->buf_start++;
390 391 392 393 394 395 396 397

	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 已提交
398
	uint16_t ret;
399

S
Sascha Hauer 已提交
400 401
	ret = *(uint16_t *)(host->data_buf + host->buf_start);
	host->buf_start += 2;
402 403 404 405 406 407 408 409 410 411 412 413

	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 已提交
414 415
	u16 col = host->buf_start;
	int n = mtd->oobsize + mtd->writesize - col;
416

S
Sascha Hauer 已提交
417
	n = min(n, len);
418

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

S
Sascha Hauer 已提交
421
	host->buf_start += n;
422 423 424 425 426 427 428 429 430 431
}

/* 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 已提交
432 433
	u16 col = host->buf_start;
	int n = mtd->oobsize + mtd->writesize - col;
434

S
Sascha Hauer 已提交
435
	n = min(n, len);
436

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

S
Sascha Hauer 已提交
439
	host->buf_start += len;
440 441 442 443 444 445 446 447 448 449 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
}

/* 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 已提交
478 479 480 481
/*
 * Function to transfer data to/from spare area.
 */
static void copy_spare(struct mtd_info *mtd, bool bfrom)
482
{
S
Sascha Hauer 已提交
483 484 485 486 487
	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;
488
	u8 *s = host->spare0;
S
Sascha Hauer 已提交
489 490 491 492 493 494 495 496 497 498 499 500 501
	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);
502

S
Sascha Hauer 已提交
503 504
		/* the last section */
		memcpy(&s[i * t], &d[i * j], mtd->oobsize - i * j);
505
	}
S
Sascha Hauer 已提交
506
}
507

508 509 510 511
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;
512 513 514 515 516 517 518

	/* 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 已提交
519
		 * we will used the saved column address to index into
520 521 522
		 * the full page.
		 */
		send_addr(host, 0, page_addr == -1);
523
		if (mtd->writesize > 512)
524 525 526 527 528 529 530 531 532
			/* another col addr cycle for 2k page */
			send_addr(host, 0, false);
	}

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

533
		if (mtd->writesize > 512) {
534 535 536
			if (mtd->size >= 0x10000000) {
				/* paddr_8 - paddr_15 */
				send_addr(host, (page_addr >> 8) & 0xff, false);
537
				send_addr(host, (page_addr >> 16) & 0xff, true);
538 539 540
			} else
				/* paddr_8 - paddr_15 */
				send_addr(host, (page_addr >> 8) & 0xff, true);
541 542 543 544 545 546 547 548 549 550 551
		} else {
			/* One more address cycle for higher density devices */
			if (mtd->size >= 0x4000000) {
				/* paddr_8 - paddr_15 */
				send_addr(host, (page_addr >> 8) & 0xff, false);
				send_addr(host, (page_addr >> 16) & 0xff, true);
			} else
				/* paddr_8 - paddr_15 */
				send_addr(host, (page_addr >> 8) & 0xff, true);
		}
	}
552 553
}

554 555 556 557 558 559
static void preset(struct mtd_info *mtd)
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
	uint16_t tmp;

I
Ivo Clarysse 已提交
560
	/* enable interrupt, disable spare enable */
561
	tmp = readw(host->regs + NFC_CONFIG1);
I
Ivo Clarysse 已提交
562
	tmp &= ~NFC_INT_MSK;
563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588
	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);
}

589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605
/* 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) {
606 607 608 609
	case NAND_CMD_RESET:
		send_cmd(host, command, false);
		preset(mtd);
		break;
610 611

	case NAND_CMD_STATUS:
S
Sascha Hauer 已提交
612
		host->buf_start = 0;
613 614
		host->status_request = true;

615 616
		send_cmd(host, command, true);
		mxc_do_addr_cycle(mtd, column, page_addr);
617 618 619 620
		break;

	case NAND_CMD_READ0:
	case NAND_CMD_READOOB:
621 622 623 624
		if (command == NAND_CMD_READ0)
			host->buf_start = column;
		else
			host->buf_start = column + mtd->writesize;
S
Sascha Hauer 已提交
625

626
		if (mtd->writesize > 512)
627
			command = NAND_CMD_READ0; /* only READ0 is valid */
628 629 630 631

		send_cmd(host, command, false);
		mxc_do_addr_cycle(mtd, column, page_addr);

632
		if (mtd->writesize > 512)
633
			send_cmd(host, NAND_CMD_READSTART, true);
634

635
		send_page(mtd, NFC_OUTPUT);
636

637
		memcpy(host->data_buf, host->main_area0, mtd->writesize);
638
		copy_spare(mtd, true);
639 640 641 642 643 644 645 646 647 648 649
		break;

	case NAND_CMD_SEQIN:
		if (column >= mtd->writesize) {
			/*
			 * FIXME: before send SEQIN command for write OOB,
			 * We must read one page out.
			 * For K9F1GXX has no READ1 command to set current HW
			 * pointer to spare area, we must write the whole page
			 * including OOB together.
			 */
650
			if (mtd->writesize > 512)
651 652 653 654
				/* call ourself to read a page */
				mxc_nand_command(mtd, NAND_CMD_READ0, 0,
						page_addr);

S
Sascha Hauer 已提交
655
			host->buf_start = column;
656 657

			/* Set program pointer to spare region */
658
			if (mtd->writesize == 512)
659 660
				send_cmd(host, NAND_CMD_READOOB, false);
		} else {
S
Sascha Hauer 已提交
661
			host->buf_start = column;
662 663

			/* Set program pointer to page start */
664
			if (mtd->writesize == 512)
665 666
				send_cmd(host, NAND_CMD_READ0, false);
		}
667 668 669

		send_cmd(host, command, false);
		mxc_do_addr_cycle(mtd, column, page_addr);
670 671 672
		break;

	case NAND_CMD_PAGEPROG:
673
		memcpy(host->main_area0, host->data_buf, mtd->writesize);
S
Sascha Hauer 已提交
674
		copy_spare(mtd, false);
675
		send_page(mtd, NFC_INPUT);
676 677
		send_cmd(host, command, true);
		mxc_do_addr_cycle(mtd, column, page_addr);
678 679 680
		break;

	case NAND_CMD_READID:
681 682
		send_cmd(host, command, true);
		mxc_do_addr_cycle(mtd, column, page_addr);
683
		send_read_id(host);
S
Sascha Hauer 已提交
684
		host->buf_start = column;
685 686
		break;

687
	case NAND_CMD_ERASE1:
688
	case NAND_CMD_ERASE2:
689 690 691
		send_cmd(host, command, false);
		mxc_do_addr_cycle(mtd, column, page_addr);

692 693 694 695
		break;
	}
}

S
Sascha Hauer 已提交
696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722
/*
 * 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,
};

723 724 725 726 727 728 729 730
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 已提交
731
	struct nand_ecclayout *oob_smallpage, *oob_largepage;
732 733

	/* Allocate memory for MTD device structure and private data */
S
Sascha Hauer 已提交
734 735
	host = kzalloc(sizeof(struct mxc_nand_host) + NAND_MAX_PAGESIZE +
			NAND_MAX_OOBSIZE, GFP_KERNEL);
736 737 738
	if (!host)
		return -ENOMEM;

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

741 742 743 744 745 746
	host->dev = &pdev->dev;
	/* structures must be linked */
	this = &host->nand;
	mtd = &host->mtd;
	mtd->priv = this;
	mtd->owner = THIS_MODULE;
747
	mtd->dev.parent = &pdev->dev;
748
	mtd->name = DRIVER_NAME;
749 750 751 752 753 754 755 756 757 758 759 760 761 762

	/* 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;

763
	host->clk = clk_get(&pdev->dev, "nfc");
764 765
	if (IS_ERR(host->clk)) {
		err = PTR_ERR(host->clk);
766
		goto eclk;
767
	}
768 769 770 771 772 773 774 775 776 777

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

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

778 779
	host->base = ioremap(res->start, resource_size(res));
	if (!host->base) {
780
		err = -ENOMEM;
781 782 783
		goto eres;
	}

784 785
	host->main_area0 = host->base;
	host->main_area1 = host->base + 0x200;
S
Sascha Hauer 已提交
786 787 788 789 790 791 792

	if (nfc_is_v21()) {
		host->regs = host->base + 0x1000;
		host->spare0 = host->base + 0x1000;
		host->spare_len = 64;
		oob_smallpage = &nandv2_hw_eccoob_smallpage;
		oob_largepage = &nandv2_hw_eccoob_largepage;
793
		this->ecc.bytes = 9;
S
Sascha Hauer 已提交
794 795 796 797 798 799 800 801 802
	} else if (nfc_is_v1()) {
		host->regs = host->base;
		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 已提交
803 804

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

807 808 809 810 811 812 813 814 815 816
	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 已提交
817
	if (pdata->width == 2)
818 819
		this->options |= NAND_BUSWIDTH_16;

S
Sascha Hauer 已提交
820 821 822 823 824
	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;
825 826
	}

827 828 829 830
	init_waitqueue_head(&host->irq_waitq);

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

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

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

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

	/* second phase scan */
	if (nand_scan_tail(mtd)) {
846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867
		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:
868
	free_irq(host->irq, host);
869
eirq:
870
	iounmap(host->base);
871 872 873 874 875 876 877 878
eres:
	clk_put(host->clk);
eclk:
	kfree(host);

	return err;
}

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

	clk_put(host->clk);

	platform_set_drvdata(pdev, NULL);

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

	return 0;
}

#ifdef CONFIG_PM
static int mxcnd_suspend(struct platform_device *pdev, pm_message_t state)
{
898 899 900
	struct mtd_info *mtd = platform_get_drvdata(pdev);
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
901 902 903
	int ret = 0;

	DEBUG(MTD_DEBUG_LEVEL0, "MXC_ND : NAND suspend\n");
904 905

	ret = mtd->suspend(mtd);
906 907 908 909 910 911

	/*
	 * nand_suspend locks the device for exclusive access, so
	 * the clock must already be off.
	 */
	BUG_ON(!ret && host->clk_act);
912 913 914 915 916 917

	return ret;
}

static int mxcnd_resume(struct platform_device *pdev)
{
918 919 920
	struct mtd_info *mtd = platform_get_drvdata(pdev);
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
921 922 923 924
	int ret = 0;

	DEBUG(MTD_DEBUG_LEVEL0, "MXC_ND : NAND resume\n");

925
	mtd->resume(mtd);
926 927 928 929 930 931 932 933 934 935 936 937 938

	return ret;
}

#else
# define mxcnd_suspend   NULL
# define mxcnd_resume    NULL
#endif				/* CONFIG_PM */

static struct platform_driver mxcnd_driver = {
	.driver = {
		   .name = DRIVER_NAME,
		   },
939
	.remove = __devexit_p(mxcnd_remove),
940 941 942 943 944 945
	.suspend = mxcnd_suspend,
	.resume = mxcnd_resume,
};

static int __init mxc_nd_init(void)
{
946
	return platform_driver_probe(&mxcnd_driver, mxcnd_probe);
947 948 949 950 951 952 953 954 955 956 957 958 959 960
}

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");