1 /* linux/drivers/mtd/nand/s3c2410.c
3 * Copyright (c) 2004,2005 Simtec Electronics
4 * http://www.simtec.co.uk/products/SWLINUX/
5 * Ben Dooks <ben@simtec.co.uk>
7 * Samsung S3C2410/S3C240 NAND driver
10 * 21-Sep-2004 BJD Initial version
11 * 23-Sep-2004 BJD Mulitple device support
12 * 28-Sep-2004 BJD Fixed ECC placement for Hardware mode
13 * 12-Oct-2004 BJD Fixed errors in use of platform data
14 * 18-Feb-2005 BJD Fix sparse errors
15 * 14-Mar-2005 BJD Applied tglx's code reduction patch
16 * 02-May-2005 BJD Fixed s3c2440 support
17 * 02-May-2005 BJD Reduced hwcontrol decode
18 * 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
23 * $Id: s3c2410.c,v 1.23 2006/04/01 18:06:29 bjd Exp $
25 * This program is free software; you can redistribute it and/or modify
26 * it under the terms of the GNU General Public License as published by
27 * the Free Software Foundation; either version 2 of the License, or
28 * (at your option) any later version.
30 * This program is distributed in the hope that it will be useful,
31 * but WITHOUT ANY WARRANTY; without even the implied warranty of
32 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
33 * GNU General Public License for more details.
35 * You should have received a copy of the GNU General Public License
36 * along with this program; if not, write to the Free Software
37 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
40 #ifdef CONFIG_MTD_NAND_S3C2410_DEBUG
44 #include <linux/module.h>
45 #include <linux/types.h>
46 #include <linux/init.h>
47 #include <linux/kernel.h>
48 #include <linux/string.h>
49 #include <linux/ioport.h>
50 #include <linux/platform_device.h>
51 #include <linux/delay.h>
52 #include <linux/err.h>
53 #include <linux/slab.h>
54 #include <linux/clk.h>
56 #include <linux/mtd/mtd.h>
57 #include <linux/mtd/nand.h>
58 #include <linux/mtd/nand_ecc.h>
59 #include <linux/mtd/partitions.h>
63 #include <asm/plat-s3c/regs-nand.h>
64 #include <asm/plat-s3c/nand.h>
66 #ifdef CONFIG_MTD_NAND_S3C2410_HWECC
67 static int hardware_ecc
= 1;
69 static int hardware_ecc
= 0;
72 #ifdef CONFIG_MTD_NAND_S3C2410_CLKSTOP
73 static int clock_stop
= 1;
75 static const int clock_stop
= 0;
79 /* new oob placement block for use with hardware ecc generation
82 static struct nand_ecclayout nand_hw_eccoob
= {
88 /* controller and mtd information */
90 struct s3c2410_nand_info
;
92 struct s3c2410_nand_mtd
{
94 struct nand_chip chip
;
95 struct s3c2410_nand_set
*set
;
96 struct s3c2410_nand_info
*info
;
106 /* overview of the s3c2410 nand state */
108 struct s3c2410_nand_info
{
110 struct nand_hw_control controller
;
111 struct s3c2410_nand_mtd
*mtds
;
112 struct s3c2410_platform_nand
*platform
;
115 struct device
*device
;
116 struct resource
*area
;
119 void __iomem
*sel_reg
;
123 unsigned long save_nfconf
;
125 enum s3c_cpu_type cpu_type
;
128 /* conversion functions */
130 static struct s3c2410_nand_mtd
*s3c2410_nand_mtd_toours(struct mtd_info
*mtd
)
132 return container_of(mtd
, struct s3c2410_nand_mtd
, mtd
);
135 static struct s3c2410_nand_info
*s3c2410_nand_mtd_toinfo(struct mtd_info
*mtd
)
137 return s3c2410_nand_mtd_toours(mtd
)->info
;
140 static struct s3c2410_nand_info
*to_nand_info(struct platform_device
*dev
)
142 return platform_get_drvdata(dev
);
145 static struct s3c2410_platform_nand
*to_nand_plat(struct platform_device
*dev
)
147 return dev
->dev
.platform_data
;
150 static inline int allow_clk_stop(struct s3c2410_nand_info
*info
)
155 /* timing calculations */
157 #define NS_IN_KHZ 1000000
159 static int s3c_nand_calc_rate(int wanted
, unsigned long clk
, int max
)
163 result
= (wanted
* clk
) / NS_IN_KHZ
;
166 pr_debug("result %d from %ld, %d\n", result
, clk
, wanted
);
169 printk("%d ns is too big for current clock rate %ld\n", wanted
, clk
);
179 #define to_ns(ticks,clk) (((ticks) * NS_IN_KHZ) / (unsigned int)(clk))
181 /* controller setup */
183 static int s3c2410_nand_inithw(struct s3c2410_nand_info
*info
,
184 struct platform_device
*pdev
)
186 struct s3c2410_platform_nand
*plat
= to_nand_plat(pdev
);
187 unsigned long clkrate
= clk_get_rate(info
->clk
);
188 int tacls_max
= (info
->cpu_type
== TYPE_S3C2412
) ? 8 : 4;
189 int tacls
, twrph0
, twrph1
;
190 unsigned long cfg
= 0;
192 /* calculate the timing information for the controller */
194 clkrate
/= 1000; /* turn clock into kHz for ease of use */
197 tacls
= s3c_nand_calc_rate(plat
->tacls
, clkrate
, tacls_max
);
198 twrph0
= s3c_nand_calc_rate(plat
->twrph0
, clkrate
, 8);
199 twrph1
= s3c_nand_calc_rate(plat
->twrph1
, clkrate
, 8);
201 /* default timings */
207 if (tacls
< 0 || twrph0
< 0 || twrph1
< 0) {
208 dev_err(info
->device
, "cannot get suitable timings\n");
212 dev_info(info
->device
, "Tacls=%d, %dns Twrph0=%d %dns, Twrph1=%d %dns\n",
213 tacls
, to_ns(tacls
, clkrate
), twrph0
, to_ns(twrph0
, clkrate
), twrph1
, to_ns(twrph1
, clkrate
));
215 switch (info
->cpu_type
) {
217 cfg
= S3C2410_NFCONF_EN
;
218 cfg
|= S3C2410_NFCONF_TACLS(tacls
- 1);
219 cfg
|= S3C2410_NFCONF_TWRPH0(twrph0
- 1);
220 cfg
|= S3C2410_NFCONF_TWRPH1(twrph1
- 1);
225 cfg
= S3C2440_NFCONF_TACLS(tacls
- 1);
226 cfg
|= S3C2440_NFCONF_TWRPH0(twrph0
- 1);
227 cfg
|= S3C2440_NFCONF_TWRPH1(twrph1
- 1);
229 /* enable the controller and de-assert nFCE */
231 writel(S3C2440_NFCONT_ENABLE
, info
->regs
+ S3C2440_NFCONT
);
234 dev_dbg(info
->device
, "NF_CONF is 0x%lx\n", cfg
);
236 writel(cfg
, info
->regs
+ S3C2410_NFCONF
);
242 static void s3c2410_nand_select_chip(struct mtd_info
*mtd
, int chip
)
244 struct s3c2410_nand_info
*info
;
245 struct s3c2410_nand_mtd
*nmtd
;
246 struct nand_chip
*this = mtd
->priv
;
252 if (chip
!= -1 && allow_clk_stop(info
))
253 clk_enable(info
->clk
);
255 cur
= readl(info
->sel_reg
);
258 cur
|= info
->sel_bit
;
260 if (nmtd
->set
!= NULL
&& chip
> nmtd
->set
->nr_chips
) {
261 dev_err(info
->device
, "invalid chip %d\n", chip
);
265 if (info
->platform
!= NULL
) {
266 if (info
->platform
->select_chip
!= NULL
)
267 (info
->platform
->select_chip
) (nmtd
->set
, chip
);
270 cur
&= ~info
->sel_bit
;
273 writel(cur
, info
->sel_reg
);
275 if (chip
== -1 && allow_clk_stop(info
))
276 clk_disable(info
->clk
);
279 /* s3c2410_nand_hwcontrol
281 * Issue command and address cycles to the chip
284 static void s3c2410_nand_hwcontrol(struct mtd_info
*mtd
, int cmd
,
287 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
289 if (cmd
== NAND_CMD_NONE
)
293 writeb(cmd
, info
->regs
+ S3C2410_NFCMD
);
295 writeb(cmd
, info
->regs
+ S3C2410_NFADDR
);
298 /* command and control functions */
300 static void s3c2440_nand_hwcontrol(struct mtd_info
*mtd
, int cmd
,
303 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
305 if (cmd
== NAND_CMD_NONE
)
309 writeb(cmd
, info
->regs
+ S3C2440_NFCMD
);
311 writeb(cmd
, info
->regs
+ S3C2440_NFADDR
);
314 /* s3c2410_nand_devready()
316 * returns 0 if the nand is busy, 1 if it is ready
319 static int s3c2410_nand_devready(struct mtd_info
*mtd
)
321 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
322 return readb(info
->regs
+ S3C2410_NFSTAT
) & S3C2410_NFSTAT_BUSY
;
325 static int s3c2440_nand_devready(struct mtd_info
*mtd
)
327 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
328 return readb(info
->regs
+ S3C2440_NFSTAT
) & S3C2440_NFSTAT_READY
;
331 static int s3c2412_nand_devready(struct mtd_info
*mtd
)
333 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
334 return readb(info
->regs
+ S3C2412_NFSTAT
) & S3C2412_NFSTAT_READY
;
337 /* ECC handling functions */
339 static int s3c2410_nand_correct_data(struct mtd_info
*mtd
, u_char
*dat
,
340 u_char
*read_ecc
, u_char
*calc_ecc
)
342 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
343 unsigned int diff0
, diff1
, diff2
;
344 unsigned int bit
, byte
;
346 pr_debug("%s(%p,%p,%p,%p)\n", __func__
, mtd
, dat
, read_ecc
, calc_ecc
);
348 diff0
= read_ecc
[0] ^ calc_ecc
[0];
349 diff1
= read_ecc
[1] ^ calc_ecc
[1];
350 diff2
= read_ecc
[2] ^ calc_ecc
[2];
352 pr_debug("%s: rd %02x%02x%02x calc %02x%02x%02x diff %02x%02x%02x\n",
354 read_ecc
[0], read_ecc
[1], read_ecc
[2],
355 calc_ecc
[0], calc_ecc
[1], calc_ecc
[2],
356 diff0
, diff1
, diff2
);
358 if (diff0
== 0 && diff1
== 0 && diff2
== 0)
359 return 0; /* ECC is ok */
361 /* Can we correct this ECC (ie, one row and column change).
362 * Note, this is similar to the 256 error code on smartmedia */
364 if (((diff0
^ (diff0
>> 1)) & 0x55) == 0x55 &&
365 ((diff1
^ (diff1
>> 1)) & 0x55) == 0x55 &&
366 ((diff2
^ (diff2
>> 1)) & 0x55) == 0x55) {
367 /* calculate the bit position of the error */
369 bit
= (diff2
>> 2) & 1;
370 bit
|= (diff2
>> 3) & 2;
371 bit
|= (diff2
>> 4) & 4;
373 /* calculate the byte position of the error */
375 byte
= (diff1
<< 1) & 0x80;
376 byte
|= (diff1
<< 2) & 0x40;
377 byte
|= (diff1
<< 3) & 0x20;
378 byte
|= (diff1
<< 4) & 0x10;
380 byte
|= (diff0
>> 3) & 0x08;
381 byte
|= (diff0
>> 2) & 0x04;
382 byte
|= (diff0
>> 1) & 0x02;
383 byte
|= (diff0
>> 0) & 0x01;
385 byte
|= (diff2
<< 8) & 0x100;
387 dev_dbg(info
->device
, "correcting error bit %d, byte %d\n",
390 dat
[byte
] ^= (1 << bit
);
394 /* if there is only one bit difference in the ECC, then
395 * one of only a row or column parity has changed, which
396 * means the error is most probably in the ECC itself */
398 diff0
|= (diff1
<< 8);
399 diff0
|= (diff2
<< 16);
401 if ((diff0
& ~(1<<fls(diff0
))) == 0)
409 * These allow the s3c2410 and s3c2440 to use the controller's ECC
410 * generator block to ECC the data as it passes through]
413 static void s3c2410_nand_enable_hwecc(struct mtd_info
*mtd
, int mode
)
415 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
418 ctrl
= readl(info
->regs
+ S3C2410_NFCONF
);
419 ctrl
|= S3C2410_NFCONF_INITECC
;
420 writel(ctrl
, info
->regs
+ S3C2410_NFCONF
);
423 static void s3c2412_nand_enable_hwecc(struct mtd_info
*mtd
, int mode
)
425 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
428 ctrl
= readl(info
->regs
+ S3C2440_NFCONT
);
429 writel(ctrl
| S3C2412_NFCONT_INIT_MAIN_ECC
, info
->regs
+ S3C2440_NFCONT
);
432 static void s3c2440_nand_enable_hwecc(struct mtd_info
*mtd
, int mode
)
434 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
437 ctrl
= readl(info
->regs
+ S3C2440_NFCONT
);
438 writel(ctrl
| S3C2440_NFCONT_INITECC
, info
->regs
+ S3C2440_NFCONT
);
441 static int s3c2410_nand_calculate_ecc(struct mtd_info
*mtd
, const u_char
*dat
, u_char
*ecc_code
)
443 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
445 ecc_code
[0] = readb(info
->regs
+ S3C2410_NFECC
+ 0);
446 ecc_code
[1] = readb(info
->regs
+ S3C2410_NFECC
+ 1);
447 ecc_code
[2] = readb(info
->regs
+ S3C2410_NFECC
+ 2);
449 pr_debug("%s: returning ecc %02x%02x%02x\n", __func__
,
450 ecc_code
[0], ecc_code
[1], ecc_code
[2]);
455 static int s3c2412_nand_calculate_ecc(struct mtd_info
*mtd
, const u_char
*dat
, u_char
*ecc_code
)
457 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
458 unsigned long ecc
= readl(info
->regs
+ S3C2412_NFMECC0
);
461 ecc_code
[1] = ecc
>> 8;
462 ecc_code
[2] = ecc
>> 16;
464 pr_debug("calculate_ecc: returning ecc %02x,%02x,%02x\n", ecc_code
[0], ecc_code
[1], ecc_code
[2]);
469 static int s3c2440_nand_calculate_ecc(struct mtd_info
*mtd
, const u_char
*dat
, u_char
*ecc_code
)
471 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
472 unsigned long ecc
= readl(info
->regs
+ S3C2440_NFMECC0
);
475 ecc_code
[1] = ecc
>> 8;
476 ecc_code
[2] = ecc
>> 16;
478 pr_debug("%s: returning ecc %06lx\n", __func__
, ecc
);
483 /* over-ride the standard functions for a little more speed. We can
484 * use read/write block to move the data buffers to/from the controller
487 static void s3c2410_nand_read_buf(struct mtd_info
*mtd
, u_char
*buf
, int len
)
489 struct nand_chip
*this = mtd
->priv
;
490 readsb(this->IO_ADDR_R
, buf
, len
);
493 static void s3c2440_nand_read_buf(struct mtd_info
*mtd
, u_char
*buf
, int len
)
495 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
496 readsl(info
->regs
+ S3C2440_NFDATA
, buf
, len
/ 4);
499 static void s3c2410_nand_write_buf(struct mtd_info
*mtd
, const u_char
*buf
, int len
)
501 struct nand_chip
*this = mtd
->priv
;
502 writesb(this->IO_ADDR_W
, buf
, len
);
505 static void s3c2440_nand_write_buf(struct mtd_info
*mtd
, const u_char
*buf
, int len
)
507 struct s3c2410_nand_info
*info
= s3c2410_nand_mtd_toinfo(mtd
);
508 writesl(info
->regs
+ S3C2440_NFDATA
, buf
, len
/ 4);
511 /* device management functions */
513 static int s3c2410_nand_remove(struct platform_device
*pdev
)
515 struct s3c2410_nand_info
*info
= to_nand_info(pdev
);
517 platform_set_drvdata(pdev
, NULL
);
522 /* first thing we need to do is release all our mtds
523 * and their partitions, then go through freeing the
527 if (info
->mtds
!= NULL
) {
528 struct s3c2410_nand_mtd
*ptr
= info
->mtds
;
531 for (mtdno
= 0; mtdno
< info
->mtd_count
; mtdno
++, ptr
++) {
532 pr_debug("releasing mtd %d (%p)\n", mtdno
, ptr
);
533 nand_release(&ptr
->mtd
);
539 /* free the common resources */
541 if (info
->clk
!= NULL
&& !IS_ERR(info
->clk
)) {
542 if (!allow_clk_stop(info
))
543 clk_disable(info
->clk
);
547 if (info
->regs
!= NULL
) {
552 if (info
->area
!= NULL
) {
553 release_resource(info
->area
);
563 #ifdef CONFIG_MTD_PARTITIONS
564 static int s3c2410_nand_add_partition(struct s3c2410_nand_info
*info
,
565 struct s3c2410_nand_mtd
*mtd
,
566 struct s3c2410_nand_set
*set
)
569 return add_mtd_device(&mtd
->mtd
);
571 if (set
->nr_partitions
> 0 && set
->partitions
!= NULL
) {
572 return add_mtd_partitions(&mtd
->mtd
, set
->partitions
, set
->nr_partitions
);
575 return add_mtd_device(&mtd
->mtd
);
578 static int s3c2410_nand_add_partition(struct s3c2410_nand_info
*info
,
579 struct s3c2410_nand_mtd
*mtd
,
580 struct s3c2410_nand_set
*set
)
582 return add_mtd_device(&mtd
->mtd
);
586 /* s3c2410_nand_init_chip
588 * init a single instance of an chip
591 static void s3c2410_nand_init_chip(struct s3c2410_nand_info
*info
,
592 struct s3c2410_nand_mtd
*nmtd
,
593 struct s3c2410_nand_set
*set
)
595 struct nand_chip
*chip
= &nmtd
->chip
;
596 void __iomem
*regs
= info
->regs
;
598 chip
->write_buf
= s3c2410_nand_write_buf
;
599 chip
->read_buf
= s3c2410_nand_read_buf
;
600 chip
->select_chip
= s3c2410_nand_select_chip
;
601 chip
->chip_delay
= 50;
604 chip
->controller
= &info
->controller
;
606 switch (info
->cpu_type
) {
608 chip
->IO_ADDR_W
= regs
+ S3C2410_NFDATA
;
609 info
->sel_reg
= regs
+ S3C2410_NFCONF
;
610 info
->sel_bit
= S3C2410_NFCONF_nFCE
;
611 chip
->cmd_ctrl
= s3c2410_nand_hwcontrol
;
612 chip
->dev_ready
= s3c2410_nand_devready
;
616 chip
->IO_ADDR_W
= regs
+ S3C2440_NFDATA
;
617 info
->sel_reg
= regs
+ S3C2440_NFCONT
;
618 info
->sel_bit
= S3C2440_NFCONT_nFCE
;
619 chip
->cmd_ctrl
= s3c2440_nand_hwcontrol
;
620 chip
->dev_ready
= s3c2440_nand_devready
;
621 chip
->read_buf
= s3c2440_nand_read_buf
;
622 chip
->write_buf
= s3c2440_nand_write_buf
;
626 chip
->IO_ADDR_W
= regs
+ S3C2440_NFDATA
;
627 info
->sel_reg
= regs
+ S3C2440_NFCONT
;
628 info
->sel_bit
= S3C2412_NFCONT_nFCE0
;
629 chip
->cmd_ctrl
= s3c2440_nand_hwcontrol
;
630 chip
->dev_ready
= s3c2412_nand_devready
;
632 if (readl(regs
+ S3C2410_NFCONF
) & S3C2412_NFCONF_NANDBOOT
)
633 dev_info(info
->device
, "System booted from NAND\n");
638 chip
->IO_ADDR_R
= chip
->IO_ADDR_W
;
641 nmtd
->mtd
.priv
= chip
;
642 nmtd
->mtd
.owner
= THIS_MODULE
;
646 chip
->ecc
.calculate
= s3c2410_nand_calculate_ecc
;
647 chip
->ecc
.correct
= s3c2410_nand_correct_data
;
648 chip
->ecc
.mode
= NAND_ECC_HW
;
649 chip
->ecc
.size
= 512;
651 chip
->ecc
.layout
= &nand_hw_eccoob
;
653 switch (info
->cpu_type
) {
655 chip
->ecc
.hwctl
= s3c2410_nand_enable_hwecc
;
656 chip
->ecc
.calculate
= s3c2410_nand_calculate_ecc
;
660 chip
->ecc
.hwctl
= s3c2412_nand_enable_hwecc
;
661 chip
->ecc
.calculate
= s3c2412_nand_calculate_ecc
;
665 chip
->ecc
.hwctl
= s3c2440_nand_enable_hwecc
;
666 chip
->ecc
.calculate
= s3c2440_nand_calculate_ecc
;
671 chip
->ecc
.mode
= NAND_ECC_SOFT
;
675 /* s3c2410_nand_probe
677 * called by device layer when it finds a device matching
678 * one our driver can handled. This code checks to see if
679 * it can allocate all necessary resources then calls the
680 * nand layer to look for devices
683 static int s3c24xx_nand_probe(struct platform_device
*pdev
,
684 enum s3c_cpu_type cpu_type
)
686 struct s3c2410_platform_nand
*plat
= to_nand_plat(pdev
);
687 struct s3c2410_nand_info
*info
;
688 struct s3c2410_nand_mtd
*nmtd
;
689 struct s3c2410_nand_set
*sets
;
690 struct resource
*res
;
696 pr_debug("s3c2410_nand_probe(%p)\n", pdev
);
698 info
= kmalloc(sizeof(*info
), GFP_KERNEL
);
700 dev_err(&pdev
->dev
, "no memory for flash info\n");
705 memzero(info
, sizeof(*info
));
706 platform_set_drvdata(pdev
, info
);
708 spin_lock_init(&info
->controller
.lock
);
709 init_waitqueue_head(&info
->controller
.wq
);
711 /* get the clock source and enable it */
713 info
->clk
= clk_get(&pdev
->dev
, "nand");
714 if (IS_ERR(info
->clk
)) {
715 dev_err(&pdev
->dev
, "failed to get clock\n");
720 clk_enable(info
->clk
);
722 /* allocate and map the resource */
724 /* currently we assume we have the one resource */
725 res
= pdev
->resource
;
726 size
= res
->end
- res
->start
+ 1;
728 info
->area
= request_mem_region(res
->start
, size
, pdev
->name
);
730 if (info
->area
== NULL
) {
731 dev_err(&pdev
->dev
, "cannot reserve register region\n");
736 info
->device
= &pdev
->dev
;
737 info
->platform
= plat
;
738 info
->regs
= ioremap(res
->start
, size
);
739 info
->cpu_type
= cpu_type
;
741 if (info
->regs
== NULL
) {
742 dev_err(&pdev
->dev
, "cannot reserve register region\n");
747 dev_dbg(&pdev
->dev
, "mapped registers at %p\n", info
->regs
);
749 /* initialise the hardware */
751 err
= s3c2410_nand_inithw(info
, pdev
);
755 sets
= (plat
!= NULL
) ? plat
->sets
: NULL
;
756 nr_sets
= (plat
!= NULL
) ? plat
->nr_sets
: 1;
758 info
->mtd_count
= nr_sets
;
760 /* allocate our information */
762 size
= nr_sets
* sizeof(*info
->mtds
);
763 info
->mtds
= kmalloc(size
, GFP_KERNEL
);
764 if (info
->mtds
== NULL
) {
765 dev_err(&pdev
->dev
, "failed to allocate mtd storage\n");
770 memzero(info
->mtds
, size
);
772 /* initialise all possible chips */
776 for (setno
= 0; setno
< nr_sets
; setno
++, nmtd
++) {
777 pr_debug("initialising set %d (%p, info %p)\n", setno
, nmtd
, info
);
779 s3c2410_nand_init_chip(info
, nmtd
, sets
);
781 nmtd
->scan_res
= nand_scan(&nmtd
->mtd
, (sets
) ? sets
->nr_chips
: 1);
783 if (nmtd
->scan_res
== 0) {
784 s3c2410_nand_add_partition(info
, nmtd
, sets
);
791 if (allow_clk_stop(info
)) {
792 dev_info(&pdev
->dev
, "clock idle support enabled\n");
793 clk_disable(info
->clk
);
796 pr_debug("initialised ok\n");
800 s3c2410_nand_remove(pdev
);
810 static int s3c24xx_nand_suspend(struct platform_device
*dev
, pm_message_t pm
)
812 struct s3c2410_nand_info
*info
= platform_get_drvdata(dev
);
815 info
->save_nfconf
= readl(info
->regs
+ S3C2410_NFCONF
);
817 /* For the moment, we must ensure nFCE is high during
818 * the time we are suspended. This really should be
819 * handled by suspending the MTDs we are using, but
820 * that is currently not the case. */
822 writel(info
->save_nfconf
| info
->sel_bit
,
823 info
->regs
+ S3C2410_NFCONF
);
825 if (!allow_clk_stop(info
))
826 clk_disable(info
->clk
);
832 static int s3c24xx_nand_resume(struct platform_device
*dev
)
834 struct s3c2410_nand_info
*info
= platform_get_drvdata(dev
);
835 unsigned long nfconf
;
838 clk_enable(info
->clk
);
839 s3c2410_nand_inithw(info
, dev
);
841 /* Restore the state of the nFCE line. */
843 nfconf
= readl(info
->regs
+ S3C2410_NFCONF
);
844 nfconf
&= ~info
->sel_bit
;
845 nfconf
|= info
->save_nfconf
& info
->sel_bit
;
846 writel(nfconf
, info
->regs
+ S3C2410_NFCONF
);
848 if (allow_clk_stop(info
))
849 clk_disable(info
->clk
);
856 #define s3c24xx_nand_suspend NULL
857 #define s3c24xx_nand_resume NULL
860 /* driver device registration */
862 static int s3c2410_nand_probe(struct platform_device
*dev
)
864 return s3c24xx_nand_probe(dev
, TYPE_S3C2410
);
867 static int s3c2440_nand_probe(struct platform_device
*dev
)
869 return s3c24xx_nand_probe(dev
, TYPE_S3C2440
);
872 static int s3c2412_nand_probe(struct platform_device
*dev
)
874 return s3c24xx_nand_probe(dev
, TYPE_S3C2412
);
877 static struct platform_driver s3c2410_nand_driver
= {
878 .probe
= s3c2410_nand_probe
,
879 .remove
= s3c2410_nand_remove
,
880 .suspend
= s3c24xx_nand_suspend
,
881 .resume
= s3c24xx_nand_resume
,
883 .name
= "s3c2410-nand",
884 .owner
= THIS_MODULE
,
888 static struct platform_driver s3c2440_nand_driver
= {
889 .probe
= s3c2440_nand_probe
,
890 .remove
= s3c2410_nand_remove
,
891 .suspend
= s3c24xx_nand_suspend
,
892 .resume
= s3c24xx_nand_resume
,
894 .name
= "s3c2440-nand",
895 .owner
= THIS_MODULE
,
899 static struct platform_driver s3c2412_nand_driver
= {
900 .probe
= s3c2412_nand_probe
,
901 .remove
= s3c2410_nand_remove
,
902 .suspend
= s3c24xx_nand_suspend
,
903 .resume
= s3c24xx_nand_resume
,
905 .name
= "s3c2412-nand",
906 .owner
= THIS_MODULE
,
910 static int __init
s3c2410_nand_init(void)
912 printk("S3C24XX NAND Driver, (c) 2004 Simtec Electronics\n");
914 platform_driver_register(&s3c2412_nand_driver
);
915 platform_driver_register(&s3c2440_nand_driver
);
916 return platform_driver_register(&s3c2410_nand_driver
);
919 static void __exit
s3c2410_nand_exit(void)
921 platform_driver_unregister(&s3c2412_nand_driver
);
922 platform_driver_unregister(&s3c2440_nand_driver
);
923 platform_driver_unregister(&s3c2410_nand_driver
);
926 module_init(s3c2410_nand_init
);
927 module_exit(s3c2410_nand_exit
);
929 MODULE_LICENSE("GPL");
930 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
931 MODULE_DESCRIPTION("S3C24XX MTD NAND driver");