Loading drivers/mtd/onenand/omap-onenand.c +89 −182 Original line number Diff line number Diff line Loading @@ -4,236 +4,143 @@ * Copyright (c) 2005 Samsung Electronics * Kyungmin Park <kyungmin.park@samsung.com> * * Derived from linux/drivers/mtd/nand/omap-nand-flash.c * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * Overview: * This is a device driver for the OneNAND flash device for TI OMAP boards. * This is a device driver for the OneNAND flash for OMAP boards. */ #include <linux/slab.h> #include <linux/init.h> #include <linux/device.h> #include <linux/module.h> #include <linux/init.h> #include <linux/mtd/mtd.h> #include <linux/mtd/onenand.h> #include <linux/mtd/partitions.h> #include <asm/io.h> #include <asm/arch/hardware.h> #include <asm/arch/tc.h> #include <asm/sizes.h> #include <asm/mach-types.h> #include <asm/mach/flash.h> #define OMAP_ONENAND_FLASH_START1 OMAP_CS2A_PHYS #define OMAP_ONENAND_FLASH_START2 omap_cs3_phys() /* * MTD structure for OMAP board */ static struct mtd_info *omap_onenand_mtd = NULL; #define DRIVER_NAME "onenand" /* * Define partitions for flash devices */ #ifdef CONFIG_MTD_PARTITIONS static struct mtd_partition static_partition[] = { { .name = "X-Loader + U-Boot", .offset = 0, .size = SZ_128K, .mask_flags = MTD_WRITEABLE /* force read-only */ }, { .name = "U-Boot Environment", .offset = MTDPART_OFS_APPEND, .size = SZ_128K, .mask_flags = MTD_WRITEABLE /* force read-only */ }, { .name = "kernel", .offset = MTDPART_OFS_APPEND, .size = 2 * SZ_1M }, { .name = "filesystem0", .offset = MTDPART_OFS_APPEND, .size = SZ_16M, }, { .name = "filesystem1", .offset = MTDPART_OFS_APPEND, .size = MTDPART_SIZ_FULL, }, }; static const char *part_probes[] = { "cmdlinepart", NULL, }; #endif #ifdef CONFIG_MTD_ONENAND_SYNC_READ static unsigned int omap_emifs_cs; static void omap_find_emifs_cs(unsigned int addr) { /* Check CS3 */ if (OMAP_EMIFS_CONFIG_REG & OMAP_EMIFS_CONFIG_BM && addr == 0x0) { omap_emifs_cs = 3; } else { omap_emifs_cs = (addr >> 26); } } struct omap_onenand_info { struct mtd_info mtd; struct mtd_partition *parts; struct onenand_chip onenand; }; /** * omap_onenand_mmcontrol - Control OMAP EMIFS */ static void omap_onenand_mmcontrol(struct mtd_info *mtd, int sync_read) static int __devinit omap_onenand_probe(struct device *dev) { struct onenand_chip *this = mtd->priv; static unsigned long omap_emifs_ccs, omap_emifs_acs; static unsigned long onenand_sys_cfg1; int config, emifs_ccs, emifs_acs; if (sync_read) { /* * Note: BRL and RDWST is equal */ omap_emifs_ccs = EMIFS_CCS(omap_emifs_cs); omap_emifs_acs = EMIFS_ACS(omap_emifs_cs); emifs_ccs = 0x41141; emifs_acs = 0x1; /* OneNAND System Configuration 1 */ onenand_sys_cfg1 = this->read_word(this->base + ONENAND_REG_SYS_CFG1); config = (onenand_sys_cfg1 & ~(0x3f << ONENAND_SYS_CFG1_BL_SHIFT)) | ONENAND_SYS_CFG1_SYNC_READ | ONENAND_SYS_CFG1_BRL_4 | ONENAND_SYS_CFG1_BL_8; } else { emifs_ccs = omap_emifs_ccs; emifs_acs = omap_emifs_acs; config = onenand_sys_cfg1; } this->write_word(config, this->base + ONENAND_REG_SYS_CFG1); EMIFS_CCS(omap_emifs_cs) = emifs_ccs; EMIFS_ACS(omap_emifs_cs) = emifs_acs; struct omap_onenand_info *info; struct platform_device *pdev = to_platform_device(dev); struct onenand_platform_data *pdata = pdev->dev.platform_data; struct resource *res = pdev->resource; unsigned long size = res->end - res->start + 1; int err; info = kmalloc(sizeof(struct omap_onenand_info), GFP_KERNEL); if (!info) return -ENOMEM; memset(info, 0, sizeof(struct omap_onenand_info)); if (!request_mem_region(res->start, size, dev->driver->name)) { err = -EBUSY; goto out_free_info; } #else #define omap_find_emifs_cs(x) do { } while (0) #define omap_onenand_mmcontrol NULL #endif /* Scan to find existance of the device at base. This also allocates oob and data internal buffers */ static char onenand_name[] = "onenand"; /* * Main initialization routine */ static int __init omap_onenand_init (void) { struct onenand_chip *this; struct mtd_partition *dynamic_partition = 0; int err = 0; /* Allocate memory for MTD device structure and private data */ omap_onenand_mtd = kmalloc (sizeof(struct mtd_info) + sizeof (struct onenand_chip), GFP_KERNEL); if (!omap_onenand_mtd) { printk (KERN_WARNING "Unable to allocate OneNAND MTD device structure.\n"); info->onenand.base = ioremap(res->start, size); if (!info->onenand.base) { err = -ENOMEM; goto out; goto out_release_mem_region; } /* Get pointer to private data */ this = (struct onenand_chip *) (&omap_onenand_mtd[1]); info->onenand.mmcontrol = pdata->mmcontrol; /* Initialize structures */ memset((char *) omap_onenand_mtd, 0, sizeof(struct mtd_info) + sizeof(struct onenand_chip)); info->mtd.name = pdev->dev.bus_id; info->mtd.priv = &info->onenand; info->mtd.owner = THIS_MODULE; /* Link the private data with the MTD structure */ omap_onenand_mtd->priv = this; this->mmcontrol = omap_onenand_mmcontrol; /* try the first address */ this->base = ioremap(OMAP_ONENAND_FLASH_START1, SZ_128K); omap_find_emifs_cs(OMAP_ONENAND_FLASH_START1); omap_onenand_mtd->name = onenand_name; if (onenand_scan(omap_onenand_mtd, 1)){ /* try the second address */ iounmap(this->base); this->base = ioremap(OMAP_ONENAND_FLASH_START2, SZ_128K); omap_find_emifs_cs(OMAP_ONENAND_FLASH_START2); if (onenand_scan(omap_onenand_mtd, 1)) { iounmap(this->base); if (onenand_scan(&info->mtd, 1)) { err = -ENXIO; goto out_mtd; } goto out_iounmap; } /* Register the partitions */ switch (omap_onenand_mtd->size) { case SZ_128M: case SZ_64M: case SZ_32M: #ifdef CONFIG_MTD_PARTITIONS err = parse_mtd_partitions(omap_onenand_mtd, part_probes, &dynamic_partition, 0); err = parse_mtd_partitions(&info->mtd, part_probes, &info->parts, 0); if (err > 0) err = add_mtd_partitions(omap_onenand_mtd, dynamic_partition, err); else if (1) err = add_mtd_partitions(omap_onenand_mtd, static_partition, ARRAY_SIZE(static_partition)); add_mtd_partitions(&info->mtd, info->parts, err); else if (err < 0 && pdata->parts) add_mtd_partitions(&info->mtd, pdata->parts, pdata->nr_parts); else #endif err = add_mtd_device(omap_onenand_mtd); if (err) goto out_buf; break; err = add_mtd_device(&info->mtd); default: printk(KERN_WARNING "Unsupported OneNAND device\n"); err = -ENXIO; goto out_buf; } dev_set_drvdata(&pdev->dev, info); return 0; out_buf: onenand_release(omap_onenand_mtd); iounmap(this->base); out_mtd: kfree(omap_onenand_mtd); out: out_iounmap: iounmap(info->onenand.base); out_release_mem_region: release_mem_region(res->start, size); out_free_info: kfree(info); return err; } /* * Clean up routine */ static void __exit omap_onenand_cleanup (void) static int __devexit omap_onenand_remove(struct device *dev) { struct onenand_chip *this = omap_onenand_mtd->priv; struct platform_device *pdev = to_platform_device(dev); struct omap_onenand_info *info = dev_get_drvdata(&pdev->dev); struct resource *res = pdev->resource; unsigned long size = res->end - res->start + 1; dev_set_drvdata(&pdev->dev, NULL); /* onenand_release frees MTD partitions, MTD structure and onenand internal buffers */ onenand_release(omap_onenand_mtd); iounmap(this->base); kfree(omap_onenand_mtd); if (info) { if (info->parts) del_mtd_partitions(&info->mtd); else del_mtd_device(&info->mtd); onenand_release(&info->mtd); release_mem_region(res->start, size); iounmap(info->onenand.base); kfree(info); } return 0; } static struct device_driver omap_onenand_driver = { .name = DRIVER_NAME, .bus = &platform_bus_type, .probe = omap_onenand_probe, .remove = __devexit_p(omap_onenand_remove), }; MODULE_ALIAS(DRIVER_NAME); static int __init omap_onenand_init(void) { return driver_register(&omap_onenand_driver); } static void __exit omap_onenand_exit(void) { driver_unregister(&omap_onenand_driver); } module_init(omap_onenand_init); module_exit(omap_onenand_cleanup); module_exit(omap_onenand_exit); MODULE_LICENSE("GPL"); MODULE_AUTHOR("Kyungmin Park <kyungmin.park@samsung.com>"); Loading include/linux/mtd/onenand.h +8 −0 Original line number Diff line number Diff line Loading @@ -115,10 +115,18 @@ struct onenand_chip { void *priv; }; /* * Helper macros */ #define ONENAND_CURRENT_BUFFERRAM(this) (this->bufferram_index) #define ONENAND_NEXT_BUFFERRAM(this) (this->bufferram_index ^ 1) #define ONENAND_SET_NEXT_BUFFERRAM(this) (this->bufferram_index ^= 1) #define ONENAND_GET_SYS_CFG1(this) \ (this->read_word(this->base + ONENAND_REG_SYS_CFG1)) #define ONENAND_SET_SYS_CFG1(v, this) \ (this->write_word(v, this->base + ONENAND_REG_SYS_CFG1)) /* * Options bits */ Loading Loading
drivers/mtd/onenand/omap-onenand.c +89 −182 Original line number Diff line number Diff line Loading @@ -4,236 +4,143 @@ * Copyright (c) 2005 Samsung Electronics * Kyungmin Park <kyungmin.park@samsung.com> * * Derived from linux/drivers/mtd/nand/omap-nand-flash.c * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * Overview: * This is a device driver for the OneNAND flash device for TI OMAP boards. * This is a device driver for the OneNAND flash for OMAP boards. */ #include <linux/slab.h> #include <linux/init.h> #include <linux/device.h> #include <linux/module.h> #include <linux/init.h> #include <linux/mtd/mtd.h> #include <linux/mtd/onenand.h> #include <linux/mtd/partitions.h> #include <asm/io.h> #include <asm/arch/hardware.h> #include <asm/arch/tc.h> #include <asm/sizes.h> #include <asm/mach-types.h> #include <asm/mach/flash.h> #define OMAP_ONENAND_FLASH_START1 OMAP_CS2A_PHYS #define OMAP_ONENAND_FLASH_START2 omap_cs3_phys() /* * MTD structure for OMAP board */ static struct mtd_info *omap_onenand_mtd = NULL; #define DRIVER_NAME "onenand" /* * Define partitions for flash devices */ #ifdef CONFIG_MTD_PARTITIONS static struct mtd_partition static_partition[] = { { .name = "X-Loader + U-Boot", .offset = 0, .size = SZ_128K, .mask_flags = MTD_WRITEABLE /* force read-only */ }, { .name = "U-Boot Environment", .offset = MTDPART_OFS_APPEND, .size = SZ_128K, .mask_flags = MTD_WRITEABLE /* force read-only */ }, { .name = "kernel", .offset = MTDPART_OFS_APPEND, .size = 2 * SZ_1M }, { .name = "filesystem0", .offset = MTDPART_OFS_APPEND, .size = SZ_16M, }, { .name = "filesystem1", .offset = MTDPART_OFS_APPEND, .size = MTDPART_SIZ_FULL, }, }; static const char *part_probes[] = { "cmdlinepart", NULL, }; #endif #ifdef CONFIG_MTD_ONENAND_SYNC_READ static unsigned int omap_emifs_cs; static void omap_find_emifs_cs(unsigned int addr) { /* Check CS3 */ if (OMAP_EMIFS_CONFIG_REG & OMAP_EMIFS_CONFIG_BM && addr == 0x0) { omap_emifs_cs = 3; } else { omap_emifs_cs = (addr >> 26); } } struct omap_onenand_info { struct mtd_info mtd; struct mtd_partition *parts; struct onenand_chip onenand; }; /** * omap_onenand_mmcontrol - Control OMAP EMIFS */ static void omap_onenand_mmcontrol(struct mtd_info *mtd, int sync_read) static int __devinit omap_onenand_probe(struct device *dev) { struct onenand_chip *this = mtd->priv; static unsigned long omap_emifs_ccs, omap_emifs_acs; static unsigned long onenand_sys_cfg1; int config, emifs_ccs, emifs_acs; if (sync_read) { /* * Note: BRL and RDWST is equal */ omap_emifs_ccs = EMIFS_CCS(omap_emifs_cs); omap_emifs_acs = EMIFS_ACS(omap_emifs_cs); emifs_ccs = 0x41141; emifs_acs = 0x1; /* OneNAND System Configuration 1 */ onenand_sys_cfg1 = this->read_word(this->base + ONENAND_REG_SYS_CFG1); config = (onenand_sys_cfg1 & ~(0x3f << ONENAND_SYS_CFG1_BL_SHIFT)) | ONENAND_SYS_CFG1_SYNC_READ | ONENAND_SYS_CFG1_BRL_4 | ONENAND_SYS_CFG1_BL_8; } else { emifs_ccs = omap_emifs_ccs; emifs_acs = omap_emifs_acs; config = onenand_sys_cfg1; } this->write_word(config, this->base + ONENAND_REG_SYS_CFG1); EMIFS_CCS(omap_emifs_cs) = emifs_ccs; EMIFS_ACS(omap_emifs_cs) = emifs_acs; struct omap_onenand_info *info; struct platform_device *pdev = to_platform_device(dev); struct onenand_platform_data *pdata = pdev->dev.platform_data; struct resource *res = pdev->resource; unsigned long size = res->end - res->start + 1; int err; info = kmalloc(sizeof(struct omap_onenand_info), GFP_KERNEL); if (!info) return -ENOMEM; memset(info, 0, sizeof(struct omap_onenand_info)); if (!request_mem_region(res->start, size, dev->driver->name)) { err = -EBUSY; goto out_free_info; } #else #define omap_find_emifs_cs(x) do { } while (0) #define omap_onenand_mmcontrol NULL #endif /* Scan to find existance of the device at base. This also allocates oob and data internal buffers */ static char onenand_name[] = "onenand"; /* * Main initialization routine */ static int __init omap_onenand_init (void) { struct onenand_chip *this; struct mtd_partition *dynamic_partition = 0; int err = 0; /* Allocate memory for MTD device structure and private data */ omap_onenand_mtd = kmalloc (sizeof(struct mtd_info) + sizeof (struct onenand_chip), GFP_KERNEL); if (!omap_onenand_mtd) { printk (KERN_WARNING "Unable to allocate OneNAND MTD device structure.\n"); info->onenand.base = ioremap(res->start, size); if (!info->onenand.base) { err = -ENOMEM; goto out; goto out_release_mem_region; } /* Get pointer to private data */ this = (struct onenand_chip *) (&omap_onenand_mtd[1]); info->onenand.mmcontrol = pdata->mmcontrol; /* Initialize structures */ memset((char *) omap_onenand_mtd, 0, sizeof(struct mtd_info) + sizeof(struct onenand_chip)); info->mtd.name = pdev->dev.bus_id; info->mtd.priv = &info->onenand; info->mtd.owner = THIS_MODULE; /* Link the private data with the MTD structure */ omap_onenand_mtd->priv = this; this->mmcontrol = omap_onenand_mmcontrol; /* try the first address */ this->base = ioremap(OMAP_ONENAND_FLASH_START1, SZ_128K); omap_find_emifs_cs(OMAP_ONENAND_FLASH_START1); omap_onenand_mtd->name = onenand_name; if (onenand_scan(omap_onenand_mtd, 1)){ /* try the second address */ iounmap(this->base); this->base = ioremap(OMAP_ONENAND_FLASH_START2, SZ_128K); omap_find_emifs_cs(OMAP_ONENAND_FLASH_START2); if (onenand_scan(omap_onenand_mtd, 1)) { iounmap(this->base); if (onenand_scan(&info->mtd, 1)) { err = -ENXIO; goto out_mtd; } goto out_iounmap; } /* Register the partitions */ switch (omap_onenand_mtd->size) { case SZ_128M: case SZ_64M: case SZ_32M: #ifdef CONFIG_MTD_PARTITIONS err = parse_mtd_partitions(omap_onenand_mtd, part_probes, &dynamic_partition, 0); err = parse_mtd_partitions(&info->mtd, part_probes, &info->parts, 0); if (err > 0) err = add_mtd_partitions(omap_onenand_mtd, dynamic_partition, err); else if (1) err = add_mtd_partitions(omap_onenand_mtd, static_partition, ARRAY_SIZE(static_partition)); add_mtd_partitions(&info->mtd, info->parts, err); else if (err < 0 && pdata->parts) add_mtd_partitions(&info->mtd, pdata->parts, pdata->nr_parts); else #endif err = add_mtd_device(omap_onenand_mtd); if (err) goto out_buf; break; err = add_mtd_device(&info->mtd); default: printk(KERN_WARNING "Unsupported OneNAND device\n"); err = -ENXIO; goto out_buf; } dev_set_drvdata(&pdev->dev, info); return 0; out_buf: onenand_release(omap_onenand_mtd); iounmap(this->base); out_mtd: kfree(omap_onenand_mtd); out: out_iounmap: iounmap(info->onenand.base); out_release_mem_region: release_mem_region(res->start, size); out_free_info: kfree(info); return err; } /* * Clean up routine */ static void __exit omap_onenand_cleanup (void) static int __devexit omap_onenand_remove(struct device *dev) { struct onenand_chip *this = omap_onenand_mtd->priv; struct platform_device *pdev = to_platform_device(dev); struct omap_onenand_info *info = dev_get_drvdata(&pdev->dev); struct resource *res = pdev->resource; unsigned long size = res->end - res->start + 1; dev_set_drvdata(&pdev->dev, NULL); /* onenand_release frees MTD partitions, MTD structure and onenand internal buffers */ onenand_release(omap_onenand_mtd); iounmap(this->base); kfree(omap_onenand_mtd); if (info) { if (info->parts) del_mtd_partitions(&info->mtd); else del_mtd_device(&info->mtd); onenand_release(&info->mtd); release_mem_region(res->start, size); iounmap(info->onenand.base); kfree(info); } return 0; } static struct device_driver omap_onenand_driver = { .name = DRIVER_NAME, .bus = &platform_bus_type, .probe = omap_onenand_probe, .remove = __devexit_p(omap_onenand_remove), }; MODULE_ALIAS(DRIVER_NAME); static int __init omap_onenand_init(void) { return driver_register(&omap_onenand_driver); } static void __exit omap_onenand_exit(void) { driver_unregister(&omap_onenand_driver); } module_init(omap_onenand_init); module_exit(omap_onenand_cleanup); module_exit(omap_onenand_exit); MODULE_LICENSE("GPL"); MODULE_AUTHOR("Kyungmin Park <kyungmin.park@samsung.com>"); Loading
include/linux/mtd/onenand.h +8 −0 Original line number Diff line number Diff line Loading @@ -115,10 +115,18 @@ struct onenand_chip { void *priv; }; /* * Helper macros */ #define ONENAND_CURRENT_BUFFERRAM(this) (this->bufferram_index) #define ONENAND_NEXT_BUFFERRAM(this) (this->bufferram_index ^ 1) #define ONENAND_SET_NEXT_BUFFERRAM(this) (this->bufferram_index ^= 1) #define ONENAND_GET_SYS_CFG1(this) \ (this->read_word(this->base + ONENAND_REG_SYS_CFG1)) #define ONENAND_SET_SYS_CFG1(v, this) \ (this->write_word(v, this->base + ONENAND_REG_SYS_CFG1)) /* * Options bits */ Loading