nand_flash_driver.rar_NAND 驱动

#include <linux/module.h> #include <linux/types.h> #include <linux/init.h> #include <linux/kernel.h> #include <linux/string.h> #include <linux/ioport.h> #include <linux/platform_device.h> #include <linux/delay.h> #include <linux/err.h> #include <linux/slab.h> #include <linux/clk.h> #include <linux/cpufreq.h> #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 <plat/regs-nand.h> #include <plat/nand.h> static unsigned long *clk_gate_ip1; static unsigned long *clk_gate_block; static unsigned long *mp0_3con; static struct mtd_partition s5pv210_nand_part[] = { [0] = { .name = "bootloader", .size = SZ_4M, .offset = 0, }, [1] = { .name = "kernel", .size = SZ_8M, .offset = MTDPART_OFS_APPEND, }, [2] = { .name = "root", .size = MTDPART_SIZ_FULL, .offset = MTDPART_OFS_APPEND, }, }; struct nand_regs { unsigned long nfconf; unsigned long nfcont; unsigned long nfcmmd; unsigned long nfaddr; unsigned long nfdata; unsigned long nfmeccd0; unsigned long nfmeccd1; unsigned long nfseccd; unsigned long nfsblk; unsigned long nfeblk; unsigned long nfstat; unsigned long nfeccerr0; unsigned long nfeccerr1; }; static struct nand_regs *nand_regs; static struct nand_chip *s5pv210_nand_chip; static struct mtd_info *s5pv210_nand_mtd; static void s5pv210_nand_select_chip(struct mtd_info *mtd, int chipnr) { if(chipnr == -1) { nand_regs->nfcont |= (1<<1); } else { nand_regs->nfcont &= ~(1<<1); } } static void s5pv210_nand_cmd_ctrl(struct mtd_info *mtd, int dat, unsigned int ctrl) { if (ctrl & NAND_CLE) { nand_regs->nfcmmd = dat; } else { nand_regs->nfaddr = dat; } } static int s5pv210_nand_dev_ready(struct mtd_info *mtd) { return (nand_regs->nfstat & (1<<0)); } static int s5pv210_nand_init(void) { s5pv210_nand_chip = kzalloc(sizeof(struct nand_chip),GFP_KERNEL); nand_regs = ioremap(0xB0E00000,sizeof(struct nand_regs)); mp0_3con = ioremap(0xE0200320,4); clk_gate_ip1 = ioremap(0xE0100464,4); clk_gate_block = ioremap(0xE0100480,4); s5pv210_nand_chip->select_chip = s5pv210_nand_select_chip; s5pv210_nand_chip->cmd_ctrl = s5pv210_nand_cmd_ctrl; s5pv210_nand_chip->IO_ADDR_R = &nand_regs->nfdata; s5pv210_nand_chip->IO_ADDR_W = &nand_regs->nfdata; s5pv210_nand_chip->dev_ready = s5pv210_nand_dev_ready; s5pv210_nand_chip->ecc.mode = NAND_ECC_SOFT; *clk_gate_ip1 = 0xffffffff; *clk_gate_block = 0xffffffff; *mp0_3con = 0x22222222; #define TWRPH1 1 #define TWRPH0 1 #define TACLS 1 nand_regs->nfconf |= (TACLS<<12) | (TWRPH0<<8) | (TWRPH1<<4); nand_regs->nfconf |= 1<<1; nand_regs->nfcont |= (1<<1)|(1<<0); s5pv210_nand_mtd = kzalloc(sizeof(struct mtd_info), GFP_KERNEL); s5pv210_nand_mtd->owner = THIS_MODULE; s5pv210_nand_mtd->priv = s5pv210_nand_chip; nand_scan(s5pv210_nand_mtd, 1); add_mtd_partitions(s5pv210_nand_mtd, s5pv210_nand_part, 3); return 0; } static void s5pv210_nand_exit(void) { del_mtd_partitions(s5pv210_nand_mtd); kfree(s5pv210_nand_mtd); iounmap(nand_regs); kfree(s5pv210_nand_chip); } module_init(s5pv210_nand_init); module_exit(s5pv210_nand_exit); MODULE_LICENSE("GPL");