s3c2410.c 19.5 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/* linux/drivers/mtd/nand/s3c2410.c
 *
B
Ben Dooks 已提交
3
 * Copyright (c) 2004,2005 Simtec Electronics
B
Ben Dooks 已提交
4 5
 *	http://www.simtec.co.uk/products/SWLINUX/
 *	Ben Dooks <ben@simtec.co.uk>
L
Linus Torvalds 已提交
6
 *
B
Ben Dooks 已提交
7
 * Samsung S3C2410/S3C240 NAND driver
L
Linus Torvalds 已提交
8 9 10 11 12 13
 *
 * Changelog:
 *	21-Sep-2004  BJD  Initial version
 *	23-Sep-2004  BJD  Mulitple device support
 *	28-Sep-2004  BJD  Fixed ECC placement for Hardware mode
 *	12-Oct-2004  BJD  Fixed errors in use of platform data
14 15
 *	18-Feb-2005  BJD  Fix sparse errors
 *	14-Mar-2005  BJD  Applied tglx's code reduction patch
B
Ben Dooks 已提交
16 17 18
 *	02-May-2005  BJD  Fixed s3c2440 support
 *	02-May-2005  BJD  Reduced hwcontrol decode
 *	20-Jun-2005  BJD  Updated s3c2440 support, fixed timing bug
19
 *	08-Jul-2005  BJD  Fix OOPS when no platform data supplied
20
 *	20-Oct-2005  BJD  Fix timing calculation bug
21
 *	14-Jan-2006  BJD  Allow clock to be stopped when idle
L
Linus Torvalds 已提交
22
 *
23
 * $Id: s3c2410.c,v 1.23 2006/04/01 18:06:29 bjd Exp $
L
Linus Torvalds 已提交
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49
 *
 * 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*/

#ifdef CONFIG_MTD_NAND_S3C2410_DEBUG
#define DEBUG
#endif

#include <linux/module.h>
#include <linux/types.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/ioport.h>
50
#include <linux/platform_device.h>
L
Linus Torvalds 已提交
51 52
#include <linux/delay.h>
#include <linux/err.h>
T
Tim Schmielau 已提交
53
#include <linux/slab.h>
54
#include <linux/clk.h>
L
Linus Torvalds 已提交
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71

#include <linux/mtd/mtd.h>
#include <linux/mtd/nand.h>
#include <linux/mtd/nand_ecc.h>
#include <linux/mtd/partitions.h>

#include <asm/io.h>

#include <asm/arch/regs-nand.h>
#include <asm/arch/nand.h>

#ifdef CONFIG_MTD_NAND_S3C2410_HWECC
static int hardware_ecc = 1;
#else
static int hardware_ecc = 0;
#endif

72 73 74 75 76 77 78
#ifdef CONFIG_MTD_NAND_S3C2410_CLKSTOP
static int clock_stop = 1;
#else
static const int clock_stop = 0;
#endif


L
Linus Torvalds 已提交
79 80 81
/* new oob placement block for use with hardware ecc generation
 */

82
static struct nand_ecclayout nand_hw_eccoob = {
83 84 85
	.eccbytes = 3,
	.eccpos = {0, 1, 2},
	.oobfree = {{8, 8}}
L
Linus Torvalds 已提交
86 87 88 89 90 91 92 93 94 95 96 97 98 99
};

/* controller and mtd information */

struct s3c2410_nand_info;

struct s3c2410_nand_mtd {
	struct mtd_info			mtd;
	struct nand_chip		chip;
	struct s3c2410_nand_set		*set;
	struct s3c2410_nand_info	*info;
	int				scan_res;
};

100 101 102 103 104 105
enum s3c_cpu_type {
	TYPE_S3C2410,
	TYPE_S3C2412,
	TYPE_S3C2440,
};

L
Linus Torvalds 已提交
106 107 108 109 110 111 112 113 114 115 116 117
/* overview of the s3c2410 nand state */

struct s3c2410_nand_info {
	/* mtd info */
	struct nand_hw_control		controller;
	struct s3c2410_nand_mtd		*mtds;
	struct s3c2410_platform_nand	*platform;

	/* device info */
	struct device			*device;
	struct resource			*area;
	struct clk			*clk;
B
Ben Dooks 已提交
118
	void __iomem			*regs;
119 120
	void __iomem			*sel_reg;
	int				sel_bit;
L
Linus Torvalds 已提交
121
	int				mtd_count;
B
Ben Dooks 已提交
122

123
	enum s3c_cpu_type		cpu_type;
L
Linus Torvalds 已提交
124 125 126 127 128 129 130 131 132 133 134 135 136 137
};

/* conversion functions */

static struct s3c2410_nand_mtd *s3c2410_nand_mtd_toours(struct mtd_info *mtd)
{
	return container_of(mtd, struct s3c2410_nand_mtd, mtd);
}

static struct s3c2410_nand_info *s3c2410_nand_mtd_toinfo(struct mtd_info *mtd)
{
	return s3c2410_nand_mtd_toours(mtd)->info;
}

138
static struct s3c2410_nand_info *to_nand_info(struct platform_device *dev)
L
Linus Torvalds 已提交
139
{
140
	return platform_get_drvdata(dev);
L
Linus Torvalds 已提交
141 142
}

143
static struct s3c2410_platform_nand *to_nand_plat(struct platform_device *dev)
L
Linus Torvalds 已提交
144
{
145
	return dev->dev.platform_data;
L
Linus Torvalds 已提交
146 147
}

148 149 150 151 152
static inline int allow_clk_stop(struct s3c2410_nand_info *info)
{
	return clock_stop;
}

L
Linus Torvalds 已提交
153 154
/* timing calculations */

155
#define NS_IN_KHZ 1000000
L
Linus Torvalds 已提交
156

157
static int s3c_nand_calc_rate(int wanted, unsigned long clk, int max)
L
Linus Torvalds 已提交
158 159 160
{
	int result;

161
	result = (wanted * clk) / NS_IN_KHZ;
L
Linus Torvalds 已提交
162 163 164 165 166
	result++;

	pr_debug("result %d from %ld, %d\n", result, clk, wanted);

	if (result > max) {
167
		printk("%d ns is too big for current clock rate %ld\n", wanted, clk);
L
Linus Torvalds 已提交
168 169 170 171 172 173 174 175 176
		return -1;
	}

	if (result < 1)
		result = 1;

	return result;
}

177
#define to_ns(ticks,clk) (((ticks) * NS_IN_KHZ) / (unsigned int)(clk))
L
Linus Torvalds 已提交
178 179 180

/* controller setup */

181 182
static int s3c2410_nand_inithw(struct s3c2410_nand_info *info,
			       struct platform_device *pdev)
L
Linus Torvalds 已提交
183
{
184
	struct s3c2410_platform_nand *plat = to_nand_plat(pdev);
L
Linus Torvalds 已提交
185
	unsigned long clkrate = clk_get_rate(info->clk);
186
	int tacls_max = (info->cpu_type == TYPE_S3C2412) ? 8 : 4;
187
	int tacls, twrph0, twrph1;
188
	unsigned long cfg = 0;
L
Linus Torvalds 已提交
189 190 191

	/* calculate the timing information for the controller */

192 193
	clkrate /= 1000;	/* turn clock into kHz for ease of use */

L
Linus Torvalds 已提交
194
	if (plat != NULL) {
195 196 197
		tacls = s3c_nand_calc_rate(plat->tacls, clkrate, tacls_max);
		twrph0 = s3c_nand_calc_rate(plat->twrph0, clkrate, 8);
		twrph1 = s3c_nand_calc_rate(plat->twrph1, clkrate, 8);
L
Linus Torvalds 已提交
198 199
	} else {
		/* default timings */
200
		tacls = tacls_max;
L
Linus Torvalds 已提交
201 202 203
		twrph0 = 8;
		twrph1 = 8;
	}
204

L
Linus Torvalds 已提交
205
	if (tacls < 0 || twrph0 < 0 || twrph1 < 0) {
206
		dev_err(info->device, "cannot get suitable timings\n");
L
Linus Torvalds 已提交
207 208 209
		return -EINVAL;
	}

210
	dev_info(info->device, "Tacls=%d, %dns Twrph0=%d %dns, Twrph1=%d %dns\n",
211
	       tacls, to_ns(tacls, clkrate), twrph0, to_ns(twrph0, clkrate), twrph1, to_ns(twrph1, clkrate));
L
Linus Torvalds 已提交
212

213 214
 	switch (info->cpu_type) {
 	case TYPE_S3C2410:
215 216 217 218
		cfg = S3C2410_NFCONF_EN;
		cfg |= S3C2410_NFCONF_TACLS(tacls - 1);
		cfg |= S3C2410_NFCONF_TWRPH0(twrph0 - 1);
		cfg |= S3C2410_NFCONF_TWRPH1(twrph1 - 1);
219 220 221 222
		break;

 	case TYPE_S3C2440:
 	case TYPE_S3C2412:
223 224 225
		cfg = S3C2440_NFCONF_TACLS(tacls - 1);
		cfg |= S3C2440_NFCONF_TWRPH0(twrph0 - 1);
		cfg |= S3C2440_NFCONF_TWRPH1(twrph1 - 1);
226 227 228

		/* enable the controller and de-assert nFCE */

229
		writel(S3C2440_NFCONT_ENABLE, info->regs + S3C2440_NFCONT);
B
Ben Dooks 已提交
230
	}
L
Linus Torvalds 已提交
231

232
	dev_dbg(info->device, "NF_CONF is 0x%lx\n", cfg);
L
Linus Torvalds 已提交
233 234 235 236 237 238 239 240 241 242

	writel(cfg, info->regs + S3C2410_NFCONF);
	return 0;
}

/* select chip */

static void s3c2410_nand_select_chip(struct mtd_info *mtd, int chip)
{
	struct s3c2410_nand_info *info;
243
	struct s3c2410_nand_mtd *nmtd;
L
Linus Torvalds 已提交
244 245 246 247 248 249
	struct nand_chip *this = mtd->priv;
	unsigned long cur;

	nmtd = this->priv;
	info = nmtd->info;

250 251 252
	if (chip != -1 && allow_clk_stop(info))
		clk_enable(info->clk);

253
	cur = readl(info->sel_reg);
L
Linus Torvalds 已提交
254 255

	if (chip == -1) {
256
		cur |= info->sel_bit;
L
Linus Torvalds 已提交
257
	} else {
258
		if (nmtd->set != NULL && chip > nmtd->set->nr_chips) {
259
			dev_err(info->device, "invalid chip %d\n", chip);
L
Linus Torvalds 已提交
260 261 262 263 264
			return;
		}

		if (info->platform != NULL) {
			if (info->platform->select_chip != NULL)
265
				(info->platform->select_chip) (nmtd->set, chip);
L
Linus Torvalds 已提交
266 267
		}

268
		cur &= ~info->sel_bit;
L
Linus Torvalds 已提交
269 270
	}

271
	writel(cur, info->sel_reg);
272 273 274

	if (chip == -1 && allow_clk_stop(info))
		clk_disable(info->clk);
L
Linus Torvalds 已提交
275 276
}

B
Ben Dooks 已提交
277
/* s3c2410_nand_hwcontrol
B
Ben Dooks 已提交
278
 *
B
Ben Dooks 已提交
279
 * Issue command and address cycles to the chip
B
Ben Dooks 已提交
280
*/
L
Linus Torvalds 已提交
281

282
static void s3c2410_nand_hwcontrol(struct mtd_info *mtd, int cmd,
283
				   unsigned int ctrl)
L
Linus Torvalds 已提交
284 285
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
D
David Woodhouse 已提交
286

287 288 289
	if (cmd == NAND_CMD_NONE)
		return;

290
	if (ctrl & NAND_CLE)
291 292 293
		writeb(cmd, info->regs + S3C2410_NFCMD);
	else
		writeb(cmd, info->regs + S3C2410_NFADDR);
B
Ben Dooks 已提交
294 295 296 297
}

/* command and control functions */

298 299
static void s3c2440_nand_hwcontrol(struct mtd_info *mtd, int cmd,
				   unsigned int ctrl)
B
Ben Dooks 已提交
300 301
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
L
Linus Torvalds 已提交
302

303 304 305
	if (cmd == NAND_CMD_NONE)
		return;

306
	if (ctrl & NAND_CLE)
307 308 309
		writeb(cmd, info->regs + S3C2440_NFCMD);
	else
		writeb(cmd, info->regs + S3C2440_NFADDR);
L
Linus Torvalds 已提交
310 311 312 313 314 315 316 317 318 319 320 321 322
}

/* s3c2410_nand_devready()
 *
 * returns 0 if the nand is busy, 1 if it is ready
*/

static int s3c2410_nand_devready(struct mtd_info *mtd)
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
	return readb(info->regs + S3C2410_NFSTAT) & S3C2410_NFSTAT_BUSY;
}

323 324 325 326 327 328 329 330 331 332 333 334
static int s3c2440_nand_devready(struct mtd_info *mtd)
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
	return readb(info->regs + S3C2440_NFSTAT) & S3C2440_NFSTAT_READY;
}

static int s3c2412_nand_devready(struct mtd_info *mtd)
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
	return readb(info->regs + S3C2412_NFSTAT) & S3C2412_NFSTAT_READY;
}

L
Linus Torvalds 已提交
335 336
/* ECC handling functions */

337 338
static int s3c2410_nand_correct_data(struct mtd_info *mtd, u_char *dat,
				     u_char *read_ecc, u_char *calc_ecc)
L
Linus Torvalds 已提交
339
{
340
	pr_debug("s3c2410_nand_correct_data(%p,%p,%p,%p)\n", mtd, dat, read_ecc, calc_ecc);
L
Linus Torvalds 已提交
341 342

	pr_debug("eccs: read %02x,%02x,%02x vs calc %02x,%02x,%02x\n",
343
		 read_ecc[0], read_ecc[1], read_ecc[2], calc_ecc[0], calc_ecc[1], calc_ecc[2]);
L
Linus Torvalds 已提交
344

345
	if (read_ecc[0] == calc_ecc[0] && read_ecc[1] == calc_ecc[1] && read_ecc[2] == calc_ecc[2])
L
Linus Torvalds 已提交
346 347 348 349 350 351 352
		return 0;

	/* we curently have no method for correcting the error */

	return -1;
}

B
Ben Dooks 已提交
353 354 355 356 357 358
/* ECC functions
 *
 * These allow the s3c2410 and s3c2440 to use the controller's ECC
 * generator block to ECC the data as it passes through]
*/

L
Linus Torvalds 已提交
359 360 361 362 363 364 365 366 367 368
static void s3c2410_nand_enable_hwecc(struct mtd_info *mtd, int mode)
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
	unsigned long ctrl;

	ctrl = readl(info->regs + S3C2410_NFCONF);
	ctrl |= S3C2410_NFCONF_INITECC;
	writel(ctrl, info->regs + S3C2410_NFCONF);
}

B
Ben Dooks 已提交
369 370 371 372 373 374 375 376 377
static void s3c2440_nand_enable_hwecc(struct mtd_info *mtd, int mode)
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
	unsigned long ctrl;

	ctrl = readl(info->regs + S3C2440_NFCONT);
	writel(ctrl | S3C2440_NFCONT_INITECC, info->regs + S3C2440_NFCONT);
}

378
static int s3c2410_nand_calculate_ecc(struct mtd_info *mtd, const u_char *dat, u_char *ecc_code)
L
Linus Torvalds 已提交
379 380 381 382 383 384 385
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);

	ecc_code[0] = readb(info->regs + S3C2410_NFECC + 0);
	ecc_code[1] = readb(info->regs + S3C2410_NFECC + 1);
	ecc_code[2] = readb(info->regs + S3C2410_NFECC + 2);

386
	pr_debug("calculate_ecc: returning ecc %02x,%02x,%02x\n", ecc_code[0], ecc_code[1], ecc_code[2]);
L
Linus Torvalds 已提交
387 388 389 390

	return 0;
}

391
static int s3c2440_nand_calculate_ecc(struct mtd_info *mtd, const u_char *dat, u_char *ecc_code)
B
Ben Dooks 已提交
392 393 394 395 396 397 398 399
{
	struct s3c2410_nand_info *info = s3c2410_nand_mtd_toinfo(mtd);
	unsigned long ecc = readl(info->regs + S3C2440_NFMECC0);

	ecc_code[0] = ecc;
	ecc_code[1] = ecc >> 8;
	ecc_code[2] = ecc >> 16;

400
	pr_debug("calculate_ecc: returning ecc %02x,%02x,%02x\n", ecc_code[0], ecc_code[1], ecc_code[2]);
B
Ben Dooks 已提交
401 402 403 404 405 406 407

	return 0;
}

/* over-ride the standard functions for a little more speed. We can
 * use read/write block to move the data buffers to/from the controller
*/
L
Linus Torvalds 已提交
408 409 410 411 412 413 414

static void s3c2410_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len)
{
	struct nand_chip *this = mtd->priv;
	readsb(this->IO_ADDR_R, buf, len);
}

415
static void s3c2410_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len)
L
Linus Torvalds 已提交
416 417 418 419 420 421 422
{
	struct nand_chip *this = mtd->priv;
	writesb(this->IO_ADDR_W, buf, len);
}

/* device management functions */

423
static int s3c2410_nand_remove(struct platform_device *pdev)
L
Linus Torvalds 已提交
424
{
425
	struct s3c2410_nand_info *info = to_nand_info(pdev);
L
Linus Torvalds 已提交
426

427
	platform_set_drvdata(pdev, NULL);
L
Linus Torvalds 已提交
428

429
	if (info == NULL)
L
Linus Torvalds 已提交
430 431 432 433
		return 0;

	/* first thing we need to do is release all our mtds
	 * and their partitions, then go through freeing the
434
	 * resources used
L
Linus Torvalds 已提交
435
	 */
436

L
Linus Torvalds 已提交
437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
	if (info->mtds != NULL) {
		struct s3c2410_nand_mtd *ptr = info->mtds;
		int mtdno;

		for (mtdno = 0; mtdno < info->mtd_count; mtdno++, ptr++) {
			pr_debug("releasing mtd %d (%p)\n", mtdno, ptr);
			nand_release(&ptr->mtd);
		}

		kfree(info->mtds);
	}

	/* free the common resources */

	if (info->clk != NULL && !IS_ERR(info->clk)) {
452 453
		if (!allow_clk_stop(info))
			clk_disable(info->clk);
L
Linus Torvalds 已提交
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
		clk_put(info->clk);
	}

	if (info->regs != NULL) {
		iounmap(info->regs);
		info->regs = NULL;
	}

	if (info->area != NULL) {
		release_resource(info->area);
		kfree(info->area);
		info->area = NULL;
	}

	kfree(info);

	return 0;
}

#ifdef CONFIG_MTD_PARTITIONS
static int s3c2410_nand_add_partition(struct s3c2410_nand_info *info,
				      struct s3c2410_nand_mtd *mtd,
				      struct s3c2410_nand_set *set)
{
	if (set == NULL)
		return add_mtd_device(&mtd->mtd);

	if (set->nr_partitions > 0 && set->partitions != NULL) {
482
		return add_mtd_partitions(&mtd->mtd, set->partitions, set->nr_partitions);
L
Linus Torvalds 已提交
483 484 485 486 487 488 489 490 491 492 493 494 495 496 497
	}

	return add_mtd_device(&mtd->mtd);
}
#else
static int s3c2410_nand_add_partition(struct s3c2410_nand_info *info,
				      struct s3c2410_nand_mtd *mtd,
				      struct s3c2410_nand_set *set)
{
	return add_mtd_device(&mtd->mtd);
}
#endif

/* s3c2410_nand_init_chip
 *
498
 * init a single instance of an chip
L
Linus Torvalds 已提交
499 500 501 502 503 504 505
*/

static void s3c2410_nand_init_chip(struct s3c2410_nand_info *info,
				   struct s3c2410_nand_mtd *nmtd,
				   struct s3c2410_nand_set *set)
{
	struct nand_chip *chip = &nmtd->chip;
506
	void __iomem *regs = info->regs;
L
Linus Torvalds 已提交
507 508 509 510 511 512 513 514 515

	chip->write_buf    = s3c2410_nand_write_buf;
	chip->read_buf     = s3c2410_nand_read_buf;
	chip->select_chip  = s3c2410_nand_select_chip;
	chip->chip_delay   = 50;
	chip->priv	   = nmtd;
	chip->options	   = 0;
	chip->controller   = &info->controller;

516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546
	switch (info->cpu_type) {
	case TYPE_S3C2410:
		chip->IO_ADDR_W = regs + S3C2410_NFDATA;
		info->sel_reg   = regs + S3C2410_NFCONF;
		info->sel_bit	= S3C2410_NFCONF_nFCE;
		chip->cmd_ctrl  = s3c2410_nand_hwcontrol;
		chip->dev_ready = s3c2410_nand_devready;
		break;

	case TYPE_S3C2440:
		chip->IO_ADDR_W = regs + S3C2440_NFDATA;
		info->sel_reg   = regs + S3C2440_NFCONT;
		info->sel_bit	= S3C2440_NFCONT_nFCE;
		chip->cmd_ctrl  = s3c2440_nand_hwcontrol;
		chip->dev_ready = s3c2440_nand_devready;
		break;

	case TYPE_S3C2412:
		chip->IO_ADDR_W = regs + S3C2440_NFDATA;
		info->sel_reg   = regs + S3C2440_NFCONT;
		info->sel_bit	= S3C2412_NFCONT_nFCE0;
		chip->cmd_ctrl  = s3c2440_nand_hwcontrol;
		chip->dev_ready = s3c2412_nand_devready;

		if (readl(regs + S3C2410_NFCONF) & S3C2412_NFCONF_NANDBOOT)
			dev_info(info->device, "System booted from NAND\n");

		break;
  	}

	chip->IO_ADDR_R = chip->IO_ADDR_W;
B
Ben Dooks 已提交
547

L
Linus Torvalds 已提交
548 549
	nmtd->info	   = info;
	nmtd->mtd.priv	   = chip;
550
	nmtd->mtd.owner    = THIS_MODULE;
L
Linus Torvalds 已提交
551 552 553
	nmtd->set	   = set;

	if (hardware_ecc) {
T
Thomas Gleixner 已提交
554
		chip->ecc.calculate = s3c2410_nand_calculate_ecc;
555
		chip->ecc.correct   = s3c2410_nand_correct_data;
T
Thomas Gleixner 已提交
556 557 558
		chip->ecc.mode	    = NAND_ECC_HW;
		chip->ecc.size	    = 512;
		chip->ecc.bytes	    = 3;
559
		chip->ecc.layout    = &nand_hw_eccoob;
B
Ben Dooks 已提交
560

561 562 563 564 565 566 567 568 569 570 571 572
		switch (info->cpu_type) {
		case TYPE_S3C2410:
			chip->ecc.hwctl	    = s3c2410_nand_enable_hwecc;
			chip->ecc.calculate = s3c2410_nand_calculate_ecc;
			break;

		case TYPE_S3C2412:
		case TYPE_S3C2440:
  			chip->ecc.hwctl     = s3c2440_nand_enable_hwecc;
  			chip->ecc.calculate = s3c2440_nand_calculate_ecc;
			break;

B
Ben Dooks 已提交
573
		}
L
Linus Torvalds 已提交
574
	} else {
T
Thomas Gleixner 已提交
575
		chip->ecc.mode	    = NAND_ECC_SOFT;
L
Linus Torvalds 已提交
576 577 578 579 580 581 582 583 584 585 586
	}
}

/* s3c2410_nand_probe
 *
 * called by device layer when it finds a device matching
 * one our driver can handled. This code checks to see if
 * it can allocate all necessary resources then calls the
 * nand layer to look for devices
*/

587 588
static int s3c24xx_nand_probe(struct platform_device *pdev,
			      enum s3c_cpu_type cpu_type)
L
Linus Torvalds 已提交
589
{
590
	struct s3c2410_platform_nand *plat = to_nand_plat(pdev);
L
Linus Torvalds 已提交
591 592 593 594 595 596 597 598 599
	struct s3c2410_nand_info *info;
	struct s3c2410_nand_mtd *nmtd;
	struct s3c2410_nand_set *sets;
	struct resource *res;
	int err = 0;
	int size;
	int nr_sets;
	int setno;

600
	pr_debug("s3c2410_nand_probe(%p)\n", pdev);
L
Linus Torvalds 已提交
601 602 603

	info = kmalloc(sizeof(*info), GFP_KERNEL);
	if (info == NULL) {
604
		dev_err(&pdev->dev, "no memory for flash info\n");
L
Linus Torvalds 已提交
605 606 607 608 609
		err = -ENOMEM;
		goto exit_error;
	}

	memzero(info, sizeof(*info));
610
	platform_set_drvdata(pdev, info);
L
Linus Torvalds 已提交
611 612

	spin_lock_init(&info->controller.lock);
B
Ben Dooks 已提交
613
	init_waitqueue_head(&info->controller.wq);
L
Linus Torvalds 已提交
614 615 616

	/* get the clock source and enable it */

617
	info->clk = clk_get(&pdev->dev, "nand");
L
Linus Torvalds 已提交
618
	if (IS_ERR(info->clk)) {
619
		dev_err(&pdev->dev, "failed to get clock");
L
Linus Torvalds 已提交
620 621 622 623 624 625 626 627
		err = -ENOENT;
		goto exit_error;
	}

	clk_enable(info->clk);

	/* allocate and map the resource */

B
Ben Dooks 已提交
628 629
	/* currently we assume we have the one resource */
	res  = pdev->resource;
L
Linus Torvalds 已提交
630 631 632 633 634
	size = res->end - res->start + 1;

	info->area = request_mem_region(res->start, size, pdev->name);

	if (info->area == NULL) {
635
		dev_err(&pdev->dev, "cannot reserve register region\n");
L
Linus Torvalds 已提交
636 637 638 639
		err = -ENOENT;
		goto exit_error;
	}

640
	info->device     = &pdev->dev;
B
Ben Dooks 已提交
641 642
	info->platform   = plat;
	info->regs       = ioremap(res->start, size);
643
	info->cpu_type   = cpu_type;
L
Linus Torvalds 已提交
644 645

	if (info->regs == NULL) {
646
		dev_err(&pdev->dev, "cannot reserve register region\n");
L
Linus Torvalds 已提交
647 648
		err = -EIO;
		goto exit_error;
649
	}
L
Linus Torvalds 已提交
650

651
	dev_dbg(&pdev->dev, "mapped registers at %p\n", info->regs);
L
Linus Torvalds 已提交
652 653 654

	/* initialise the hardware */

655
	err = s3c2410_nand_inithw(info, pdev);
L
Linus Torvalds 已提交
656 657 658 659 660 661 662 663 664 665 666 667 668
	if (err != 0)
		goto exit_error;

	sets = (plat != NULL) ? plat->sets : NULL;
	nr_sets = (plat != NULL) ? plat->nr_sets : 1;

	info->mtd_count = nr_sets;

	/* allocate our information */

	size = nr_sets * sizeof(*info->mtds);
	info->mtds = kmalloc(size, GFP_KERNEL);
	if (info->mtds == NULL) {
669
		dev_err(&pdev->dev, "failed to allocate mtd storage\n");
L
Linus Torvalds 已提交
670 671 672 673 674 675 676 677 678 679 680
		err = -ENOMEM;
		goto exit_error;
	}

	memzero(info->mtds, size);

	/* initialise all possible chips */

	nmtd = info->mtds;

	for (setno = 0; setno < nr_sets; setno++, nmtd++) {
681
		pr_debug("initialising set %d (%p, info %p)\n", setno, nmtd, info);
682

L
Linus Torvalds 已提交
683 684
		s3c2410_nand_init_chip(info, nmtd, sets);

685
		nmtd->scan_res = nand_scan(&nmtd->mtd, (sets) ? sets->nr_chips : 1);
L
Linus Torvalds 已提交
686 687 688 689 690 691 692 693

		if (nmtd->scan_res == 0) {
			s3c2410_nand_add_partition(info, nmtd, sets);
		}

		if (sets != NULL)
			sets++;
	}
694

695 696 697 698 699
	if (allow_clk_stop(info)) {
		dev_info(&pdev->dev, "clock idle support enabled\n");
		clk_disable(info->clk);
	}

L
Linus Torvalds 已提交
700 701 702 703
	pr_debug("initialised ok\n");
	return 0;

 exit_error:
704
	s3c2410_nand_remove(pdev);
L
Linus Torvalds 已提交
705 706 707 708 709 710

	if (err == 0)
		err = -EINVAL;
	return err;
}

711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745
/* PM Support */
#ifdef CONFIG_PM

static int s3c24xx_nand_suspend(struct platform_device *dev, pm_message_t pm)
{
	struct s3c2410_nand_info *info = platform_get_drvdata(dev);

	if (info) {
		if (!allow_clk_stop(info))
			clk_disable(info->clk);
	}

	return 0;
}

static int s3c24xx_nand_resume(struct platform_device *dev)
{
	struct s3c2410_nand_info *info = platform_get_drvdata(dev);

	if (info) {
		clk_enable(info->clk);
		s3c2410_nand_inithw(info, dev);

		if (allow_clk_stop(info))
			clk_disable(info->clk);
	}

	return 0;
}

#else
#define s3c24xx_nand_suspend NULL
#define s3c24xx_nand_resume NULL
#endif

B
Ben Dooks 已提交
746 747
/* driver device registration */

748
static int s3c2410_nand_probe(struct platform_device *dev)
B
Ben Dooks 已提交
749
{
750
	return s3c24xx_nand_probe(dev, TYPE_S3C2410);
B
Ben Dooks 已提交
751 752
}

753
static int s3c2440_nand_probe(struct platform_device *dev)
B
Ben Dooks 已提交
754
{
755 756 757 758 759 760
	return s3c24xx_nand_probe(dev, TYPE_S3C2440);
}

static int s3c2412_nand_probe(struct platform_device *dev)
{
	return s3c24xx_nand_probe(dev, TYPE_S3C2412);
B
Ben Dooks 已提交
761 762
}

763
static struct platform_driver s3c2410_nand_driver = {
L
Linus Torvalds 已提交
764 765
	.probe		= s3c2410_nand_probe,
	.remove		= s3c2410_nand_remove,
766 767
	.suspend	= s3c24xx_nand_suspend,
	.resume		= s3c24xx_nand_resume,
768 769 770 771
	.driver		= {
		.name	= "s3c2410-nand",
		.owner	= THIS_MODULE,
	},
L
Linus Torvalds 已提交
772 773
};

774
static struct platform_driver s3c2440_nand_driver = {
B
Ben Dooks 已提交
775 776
	.probe		= s3c2440_nand_probe,
	.remove		= s3c2410_nand_remove,
777 778
	.suspend	= s3c24xx_nand_suspend,
	.resume		= s3c24xx_nand_resume,
779 780 781 782
	.driver		= {
		.name	= "s3c2440-nand",
		.owner	= THIS_MODULE,
	},
B
Ben Dooks 已提交
783 784
};

785 786 787 788 789 790 791 792 793 794 795
static struct platform_driver s3c2412_nand_driver = {
	.probe		= s3c2412_nand_probe,
	.remove		= s3c2410_nand_remove,
	.suspend	= s3c24xx_nand_suspend,
	.resume		= s3c24xx_nand_resume,
	.driver		= {
		.name	= "s3c2412-nand",
		.owner	= THIS_MODULE,
	},
};

L
Linus Torvalds 已提交
796 797
static int __init s3c2410_nand_init(void)
{
B
Ben Dooks 已提交
798 799
	printk("S3C24XX NAND Driver, (c) 2004 Simtec Electronics\n");

800
	platform_driver_register(&s3c2412_nand_driver);
801 802
	platform_driver_register(&s3c2440_nand_driver);
	return platform_driver_register(&s3c2410_nand_driver);
L
Linus Torvalds 已提交
803 804 805 806
}

static void __exit s3c2410_nand_exit(void)
{
807
	platform_driver_unregister(&s3c2412_nand_driver);
808 809
	platform_driver_unregister(&s3c2440_nand_driver);
	platform_driver_unregister(&s3c2410_nand_driver);
L
Linus Torvalds 已提交
810 811 812 813 814 815 816
}

module_init(s3c2410_nand_init);
module_exit(s3c2410_nand_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
B
Ben Dooks 已提交
817
MODULE_DESCRIPTION("S3C24XX MTD NAND driver");