mxc_nand.c 23.5 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 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80
#define NFC_V1_V2_BUF_SIZE		(host->regs + 0x00)
#define NFC_V1_V2_BUF_ADDR		(host->regs + 0x04)
#define NFC_V1_V2_FLASH_ADDR		(host->regs + 0x06)
#define NFC_V1_V2_FLASH_CMD		(host->regs + 0x08)
#define NFC_V1_V2_CONFIG		(host->regs + 0x0a)
#define NFC_V1_V2_ECC_STATUS_RESULT	(host->regs + 0x0c)
#define NFC_V1_V2_RSLTMAIN_AREA		(host->regs + 0x0e)
#define NFC_V1_V2_RSLTSPARE_AREA	(host->regs + 0x10)
#define NFC_V1_V2_WRPROT		(host->regs + 0x12)
#define NFC_V1_UNLOCKSTART_BLKADDR	(host->regs + 0x14)
#define NFC_V1_UNLOCKEND_BLKADDR	(host->regs + 0x16)
#define NFC_V21_UNLOCKSTART_BLKADDR	(host->regs + 0x20)
#define NFC_V21_UNLOCKEND_BLKADDR	(host->regs + 0x22)
#define NFC_V1_V2_NF_WRPRST		(host->regs + 0x18)
#define NFC_V1_V2_CONFIG1		(host->regs + 0x1a)
#define NFC_V1_V2_CONFIG2		(host->regs + 0x1c)

#define NFC_V1_V2_CONFIG1_SP_EN		(1 << 2)
#define NFC_V1_V2_CONFIG1_ECC_EN	(1 << 3)
#define NFC_V1_V2_CONFIG1_INT_MSK	(1 << 4)
#define NFC_V1_V2_CONFIG1_BIG		(1 << 5)
#define NFC_V1_V2_CONFIG1_RST		(1 << 6)
#define NFC_V1_V2_CONFIG1_CE		(1 << 7)
#define NFC_V1_V2_CONFIG1_ONE_CYCLE	(1 << 8)

#define NFC_V1_V2_CONFIG2_INT		(1 << 15)

/*
 * Operation modes for the NFC. Valid for v1, v2 and v3
 * type controllers.
 */
#define NFC_CMD				(1 << 0)
#define NFC_ADDR			(1 << 1)
#define NFC_INPUT			(1 << 2)
#define NFC_OUTPUT			(1 << 3)
#define NFC_ID				(1 << 4)
#define NFC_STATUS			(1 << 5)
81 82 83 84 85 86 87

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

88 89 90 91
	void			*spare0;
	void			*main_area0;

	void __iomem		*base;
92 93 94 95 96
	void __iomem		*regs;
	int			status_request;
	struct clk		*clk;
	int			clk_act;
	int			irq;
97
	int			eccsize;
98 99 100

	wait_queue_head_t	irq_waitq;

S
Sascha Hauer 已提交
101 102 103
	uint8_t			*data_buf;
	unsigned int		buf_start;
	int			spare_len;
104 105 106 107 108 109 110

	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 *);
111
	int			(*check_int)(struct mxc_nand_host *);
112 113 114
};

/* OOB placement block for use with hardware ecc generation */
S
Sascha Hauer 已提交
115
static struct nand_ecclayout nandv1_hw_eccoob_smallpage = {
116 117
	.eccbytes = 5,
	.eccpos = {6, 7, 8, 9, 10},
118
	.oobfree = {{0, 5}, {12, 4}, }
119 120
};

S
Sascha Hauer 已提交
121
static struct nand_ecclayout nandv1_hw_eccoob_largepage = {
122 123 124 125
	.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}, }
126 127
};

S
Sascha Hauer 已提交
128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155
/* 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}
	}
};

156 157 158 159 160 161 162 163
#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 已提交
164
	disable_irq_nosync(irq);
165 166 167 168 169 170

	wake_up(&host->irq_waitq);

	return IRQ_HANDLED;
}

171 172 173 174
static int check_int_v1_v2(struct mxc_nand_host *host)
{
	uint32_t tmp;

175 176
	tmp = readw(NFC_V1_V2_CONFIG2);
	if (!(tmp & NFC_V1_V2_CONFIG2_INT))
177 178
		return 0;

179
	writew(tmp & ~NFC_V1_V2_CONFIG2_INT, NFC_V1_V2_CONFIG2);
180 181 182 183

	return 1;
}

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

	if (useirq) {
192
		if (!host->check_int(host)) {
193

I
Ivo Clarysse 已提交
194
			enable_irq(host->irq);
195

196
			wait_event(host->irq_waitq, host->check_int(host));
197 198 199
		}
	} else {
		while (max_retries-- > 0) {
200
			if (host->check_int(host))
201
				break;
202

203 204
			udelay(1);
		}
205
		if (max_retries < 0)
S
Sascha Hauer 已提交
206 207
			DEBUG(MTD_DEBUG_LEVEL0, "%s: INT not set\n",
			      __func__);
208 209 210 211 212
	}
}

/* This function issues the specified command to the NAND device and
 * waits for completion. */
213
static void send_cmd_v1_v2(struct mxc_nand_host *host, uint16_t cmd, int useirq)
214 215 216
{
	DEBUG(MTD_DEBUG_LEVEL3, "send_cmd(host, 0x%x, %d)\n", cmd, useirq);

217 218
	writew(cmd, NFC_V1_V2_FLASH_CMD);
	writew(NFC_CMD, NFC_V1_V2_CONFIG2);
219

I
Ivo Clarysse 已提交
220 221 222 223 224
	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) {
225
			if (readw(NFC_V1_V2_CONFIG2) == 0) {
I
Ivo Clarysse 已提交
226 227 228 229 230 231 232 233 234 235 236
				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);
	}
237 238 239 240 241
}

/* 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. */
242
static void send_addr_v1_v2(struct mxc_nand_host *host, uint16_t addr, int islast)
243 244 245
{
	DEBUG(MTD_DEBUG_LEVEL3, "send_addr(host, 0x%x %d)\n", addr, islast);

246 247
	writew(addr, NFC_V1_V2_FLASH_ADDR);
	writew(NFC_ADDR, NFC_V1_V2_CONFIG2);
248 249

	/* Wait for operation to complete */
S
Sascha Hauer 已提交
250
	wait_op_done(host, islast);
251 252
}

253
static void send_page_v1_v2(struct mtd_info *mtd, unsigned int ops)
254
{
255 256
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
257
	int bufs, i;
258

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

264
	for (i = 0; i < bufs; i++) {
265

266
		/* NANDFC buffer 0 is used for page read/write */
267
		writew(i, NFC_V1_V2_BUF_ADDR);
268

269
		writew(ops, NFC_V1_V2_CONFIG2);
270

271
		/* Wait for operation to complete */
S
Sascha Hauer 已提交
272
		wait_op_done(host, true);
273 274 275 276
	}
}

/* Request the NANDFC to perform a read of the NAND device ID. */
277
static void send_read_id_v1_v2(struct mxc_nand_host *host)
278 279 280 281
{
	struct nand_chip *this = &host->nand;

	/* NANDFC buffer 0 is used for device ID output */
282
	writew(0x0, NFC_V1_V2_BUF_ADDR);
283

284
	writew(NFC_ID, NFC_V1_V2_CONFIG2);
285 286

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

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

/* This function requests the NANDFC to perform a read of the
 * NAND device status and returns the current status. */
303
static uint16_t get_dev_status_v1_v2(struct mxc_nand_host *host)
304
{
S
Sascha Hauer 已提交
305
	void __iomem *main_buf = host->main_area0;
306
	uint32_t store;
307
	uint16_t ret;
308

S
Sascha Hauer 已提交
309 310 311 312 313 314 315
	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.
	 */
316 317
	store = readl(main_buf);

318
	writew(NFC_STATUS, NFC_V1_V2_CONFIG2);
S
Sascha Hauer 已提交
319
	wait_op_done(host, true);
320 321

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

323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345
	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.
	 */
}

346
static int mxc_nand_correct_data_v1(struct mtd_info *mtd, u_char *dat,
347 348 349 350 351 352 353 354 355 356
				 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
	 */
357
	uint16_t ecc_status = readw(NFC_V1_V2_ECC_STATUS_RESULT);
358 359 360 361 362 363 364 365 366 367

	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;
}

368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401
static int mxc_nand_correct_data_v2_v3(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;
	u32 ecc_stat, err;
	int no_subpages = 1;
	int ret = 0;
	u8 ecc_bit_mask, err_limit;

	ecc_bit_mask = (host->eccsize == 4) ? 0x7 : 0xf;
	err_limit = (host->eccsize == 4) ? 0x4 : 0x8;

	no_subpages = mtd->writesize >> 9;

	ecc_stat = readl(NFC_V1_V2_ECC_STATUS_RESULT);

	do {
		err = ecc_stat & ecc_bit_mask;
		if (err > err_limit) {
			printk(KERN_WARNING "UnCorrectable RS-ECC Error\n");
			return -1;
		} else {
			ret += err;
		}
		ecc_stat >>= 4;
	} while (--no_subpages);

	mtd->ecc_stats.corrected += ret;
	pr_debug("%d Symbol Correctable RS-ECC Error\n", ret);

	return ret;
}

402 403 404 405 406 407 408 409 410 411
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 已提交
412
	uint8_t ret;
413 414 415

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

S
Sascha Hauer 已提交
418 419
	ret = *(uint8_t *)(host->data_buf + host->buf_start);
	host->buf_start++;
420 421 422 423 424 425 426 427

	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 已提交
428
	uint16_t ret;
429

S
Sascha Hauer 已提交
430 431
	ret = *(uint16_t *)(host->data_buf + host->buf_start);
	host->buf_start += 2;
432 433 434 435 436 437 438 439 440 441 442 443

	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 已提交
444 445
	u16 col = host->buf_start;
	int n = mtd->oobsize + mtd->writesize - col;
446

S
Sascha Hauer 已提交
447
	n = min(n, len);
448

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

S
Sascha Hauer 已提交
451
	host->buf_start += n;
452 453 454 455 456 457 458 459 460 461
}

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

S
Sascha Hauer 已提交
465
	n = min(n, len);
466

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

S
Sascha Hauer 已提交
469
	host->buf_start += len;
470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507
}

/* 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 已提交
508 509 510 511
/*
 * Function to transfer data to/from spare area.
 */
static void copy_spare(struct mtd_info *mtd, bool bfrom)
512
{
S
Sascha Hauer 已提交
513 514 515 516 517
	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;
518
	u8 *s = host->spare0;
S
Sascha Hauer 已提交
519 520 521 522 523 524 525 526 527 528 529 530 531
	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);
532

S
Sascha Hauer 已提交
533 534
		/* the last section */
		memcpy(&s[i * t], &d[i * j], mtd->oobsize - i * j);
535
	}
S
Sascha Hauer 已提交
536
}
537

538 539 540 541
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;
542 543 544 545 546 547 548

	/* 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 已提交
549
		 * we will used the saved column address to index into
550 551
		 * the full page.
		 */
552
		host->send_addr(host, 0, page_addr == -1);
553
		if (mtd->writesize > 512)
554
			/* another col addr cycle for 2k page */
555
			host->send_addr(host, 0, false);
556 557 558 559 560
	}

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

563
		if (mtd->writesize > 512) {
564 565
			if (mtd->size >= 0x10000000) {
				/* paddr_8 - paddr_15 */
566 567
				host->send_addr(host, (page_addr >> 8) & 0xff, false);
				host->send_addr(host, (page_addr >> 16) & 0xff, true);
568 569
			} else
				/* paddr_8 - paddr_15 */
570
				host->send_addr(host, (page_addr >> 8) & 0xff, true);
571 572 573 574
		} else {
			/* One more address cycle for higher density devices */
			if (mtd->size >= 0x4000000) {
				/* paddr_8 - paddr_15 */
575 576
				host->send_addr(host, (page_addr >> 8) & 0xff, false);
				host->send_addr(host, (page_addr >> 16) & 0xff, true);
577 578
			} else
				/* paddr_8 - paddr_15 */
579
				host->send_addr(host, (page_addr >> 8) & 0xff, true);
580 581
		}
	}
582 583
}

584
static void preset_v1_v2(struct mtd_info *mtd)
585 586 587 588 589
{
	struct nand_chip *nand_chip = mtd->priv;
	struct mxc_nand_host *host = nand_chip->priv;
	uint16_t tmp;

I
Ivo Clarysse 已提交
590
	/* enable interrupt, disable spare enable */
591 592 593
	tmp = readw(NFC_V1_V2_CONFIG1);
	tmp &= ~NFC_V1_V2_CONFIG1_INT_MSK;
	tmp &= ~NFC_V1_V2_CONFIG1_SP_EN;
594
	if (nand_chip->ecc.mode == NAND_ECC_HW) {
595
		tmp |= NFC_V1_V2_CONFIG1_ECC_EN;
596
	} else {
597
		tmp &= ~NFC_V1_V2_CONFIG1_ECC_EN;
598
	}
599
	writew(tmp, NFC_V1_V2_CONFIG1);
600 601 602
	/* preset operation */

	/* Unlock the internal RAM Buffer */
603
	writew(0x2, NFC_V1_V2_CONFIG);
604 605 606

	/* Blocks to be unlocked */
	if (nfc_is_v21()) {
607 608
		writew(0x0, NFC_V21_UNLOCKSTART_BLKADDR);
		writew(0xffff, NFC_V21_UNLOCKEND_BLKADDR);
609
	} else if (nfc_is_v1()) {
610 611
		writew(0x0, NFC_V1_UNLOCKSTART_BLKADDR);
		writew(0x4000, NFC_V1_UNLOCKEND_BLKADDR);
612 613 614 615
	} else
		BUG();

	/* Unlock Block Command for given address range */
616
	writew(0x4, NFC_V1_V2_WRPROT);
617 618
}

619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635
/* 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) {
636
	case NAND_CMD_RESET:
637 638
		host->preset(mtd);
		host->send_cmd(host, command, false);
639
		break;
640 641

	case NAND_CMD_STATUS:
S
Sascha Hauer 已提交
642
		host->buf_start = 0;
643 644
		host->status_request = true;

645
		host->send_cmd(host, command, true);
646
		mxc_do_addr_cycle(mtd, column, page_addr);
647 648 649 650
		break;

	case NAND_CMD_READ0:
	case NAND_CMD_READOOB:
651 652 653 654
		if (command == NAND_CMD_READ0)
			host->buf_start = column;
		else
			host->buf_start = column + mtd->writesize;
S
Sascha Hauer 已提交
655

656
		command = NAND_CMD_READ0; /* only READ0 is valid */
657

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

661
		if (mtd->writesize > 512)
662
			host->send_cmd(host, NAND_CMD_READSTART, true);
663

664
		host->send_page(mtd, NFC_OUTPUT);
665

666
		memcpy(host->data_buf, host->main_area0, mtd->writesize);
667
		copy_spare(mtd, true);
668 669 670
		break;

	case NAND_CMD_SEQIN:
671 672 673
		if (column >= mtd->writesize)
			/* call ourself to read a page */
			mxc_nand_command(mtd, NAND_CMD_READ0, 0, page_addr);
674

675
		host->buf_start = column;
676

677
		host->send_cmd(host, command, false);
678
		mxc_do_addr_cycle(mtd, column, page_addr);
679 680 681
		break;

	case NAND_CMD_PAGEPROG:
682
		memcpy(host->main_area0, host->data_buf, mtd->writesize);
S
Sascha Hauer 已提交
683
		copy_spare(mtd, false);
684 685
		host->send_page(mtd, NFC_INPUT);
		host->send_cmd(host, command, true);
686
		mxc_do_addr_cycle(mtd, column, page_addr);
687 688 689
		break;

	case NAND_CMD_READID:
690
		host->send_cmd(host, command, true);
691
		mxc_do_addr_cycle(mtd, column, page_addr);
692
		host->send_read_id(host);
S
Sascha Hauer 已提交
693
		host->buf_start = column;
694 695
		break;

696
	case NAND_CMD_ERASE1:
697
	case NAND_CMD_ERASE2:
698
		host->send_cmd(host, command, false);
699 700
		mxc_do_addr_cycle(mtd, column, page_addr);

701 702 703 704
		break;
	}
}

S
Sascha Hauer 已提交
705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731
/*
 * 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,
};

732 733 734 735 736 737 738 739
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 已提交
740
	struct nand_ecclayout *oob_smallpage, *oob_largepage;
741 742

	/* Allocate memory for MTD device structure and private data */
S
Sascha Hauer 已提交
743 744
	host = kzalloc(sizeof(struct mxc_nand_host) + NAND_MAX_PAGESIZE +
			NAND_MAX_OOBSIZE, GFP_KERNEL);
745 746 747
	if (!host)
		return -ENOMEM;

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

750 751 752 753 754 755
	host->dev = &pdev->dev;
	/* structures must be linked */
	this = &host->nand;
	mtd = &host->mtd;
	mtd->priv = this;
	mtd->owner = THIS_MODULE;
756
	mtd->dev.parent = &pdev->dev;
757
	mtd->name = DRIVER_NAME;
758 759 760 761 762 763 764 765 766 767 768 769 770 771

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

772
	host->clk = clk_get(&pdev->dev, "nfc");
773 774
	if (IS_ERR(host->clk)) {
		err = PTR_ERR(host->clk);
775
		goto eclk;
776
	}
777 778 779 780 781 782 783 784 785 786

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

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

787 788
	host->base = ioremap(res->start, resource_size(res));
	if (!host->base) {
789
		err = -ENOMEM;
790 791 792
		goto eres;
	}

793
	host->main_area0 = host->base;
S
Sascha Hauer 已提交
794

795 796 797 798 799 800 801
	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;
802
		host->check_int = check_int_v1_v2;
803 804
	}

S
Sascha Hauer 已提交
805
	if (nfc_is_v21()) {
806
		host->regs = host->base + 0x1e00;
S
Sascha Hauer 已提交
807 808 809 810
		host->spare0 = host->base + 0x1000;
		host->spare_len = 64;
		oob_smallpage = &nandv2_hw_eccoob_smallpage;
		oob_largepage = &nandv2_hw_eccoob_largepage;
811
		this->ecc.bytes = 9;
S
Sascha Hauer 已提交
812
	} else if (nfc_is_v1()) {
813
		host->regs = host->base + 0xe00;
S
Sascha Hauer 已提交
814 815 816 817 818 819 820
		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 已提交
821 822

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

825 826 827
	if (pdata->hw_ecc) {
		this->ecc.calculate = mxc_nand_calculate_ecc;
		this->ecc.hwctl = mxc_nand_enable_hwecc;
828 829 830 831
		if (nfc_is_v1())
			this->ecc.correct = mxc_nand_correct_data_v1;
		else
			this->ecc.correct = mxc_nand_correct_data_v2_v3;
832 833 834 835 836 837
		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 已提交
838
	if (pdata->width == 2)
839 840
		this->options |= NAND_BUSWIDTH_16;

S
Sascha Hauer 已提交
841 842 843 844 845
	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;
846 847
	}

848 849 850 851
	init_waitqueue_head(&host->irq_waitq);

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

I
Ivo Clarysse 已提交
852
	err = request_irq(host->irq, mxc_nfc_irq, IRQF_DISABLED, DRIVER_NAME, host);
853 854 855
	if (err)
		goto eirq;

856
	/* first scan to find the device and get the page size */
857
	if (nand_scan_ident(mtd, 1, NULL)) {
858 859 860
		err = -ENXIO;
		goto escan;
	}
861

862
	if (mtd->writesize == 2048)
S
Sascha Hauer 已提交
863
		this->ecc.layout = oob_largepage;
864 865 866

	/* second phase scan */
	if (nand_scan_tail(mtd)) {
867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888
		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:
889
	free_irq(host->irq, host);
890
eirq:
891
	iounmap(host->base);
892 893 894 895 896 897 898 899
eres:
	clk_put(host->clk);
eclk:
	kfree(host);

	return err;
}

900
static int __devexit mxcnd_remove(struct platform_device *pdev)
901 902 903 904 905 906 907 908
{
	struct mxc_nand_host *host = platform_get_drvdata(pdev);

	clk_put(host->clk);

	platform_set_drvdata(pdev, NULL);

	nand_release(&host->mtd);
909
	free_irq(host->irq, host);
910
	iounmap(host->base);
911 912 913 914 915 916 917 918
	kfree(host);

	return 0;
}

static struct platform_driver mxcnd_driver = {
	.driver = {
		   .name = DRIVER_NAME,
919
	},
920
	.remove = __devexit_p(mxcnd_remove),
921 922 923 924
};

static int __init mxc_nd_init(void)
{
925
	return platform_driver_probe(&mxcnd_driver, mxcnd_probe);
926 927 928 929 930 931 932 933 934 935 936 937 938 939
}

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