/* * $Id: spimap.c,v 1.39 2005/11/29 14:49:36 gleixner Exp $ * * Mappings of spi chips in physical memory * * Copyright (C) 2003 MontaVista Software Inc. * Copyright (C) 2007 AVM Berlin * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net * * 031022 - [jsun] add run-time configure and partition setup */ #include #include #include #include #include #include #include #include #include #include #include #include struct spimap_flash_info { struct mtd_info *mtd; struct map_info map; struct resource *res; #ifdef CONFIG_MTD_PARTITIONS int nr_parts; struct mtd_partition *parts; #endif }; static int spimap_flash_remove(struct platform_device *dev) { struct spimap_flash_info *info; struct pagedmap_flash_data *spimap_data; info = platform_get_drvdata(dev); if (info == NULL) return 0; platform_set_drvdata(dev, NULL); spimap_data = dev->dev.platform_data; if (info->mtd != NULL) { #ifdef CONFIG_MTD_PARTITIONS if (info->nr_parts) { del_mtd_partitions(info->mtd); kfree(info->parts); } else if (spimap_data->nr_parts) { del_mtd_partitions(info->mtd); } else { del_mtd_device(info->mtd); } #else del_mtd_device(info->mtd); #endif map_destroy(info->mtd); } if (info->map.virt != NULL) iounmap(info->map.virt); if (info->res != NULL) { release_resource(info->res); kfree(info->res); } return 0; } static const char *rom_probe_types[] = { "spi_probe", NULL }; #ifdef CONFIG_MTD_PARTITIONS static const char *part_probe_types[] = { "cmdlinepart", "RedBoot", NULL }; #endif static int spimap_flash_probe(struct platform_device *dev) { struct pagedmap_flash_data *spimap_data; struct spimap_flash_info *info; const char **probe_type; int err; printk("[%s, %u] \n", __FILE__, __LINE__); spimap_data = dev->dev.platform_data; if (spimap_data == NULL) return -ENODEV; printk("[%s, %u] \n", __FILE__, __LINE__); /*--- dev->resource->start = CONFIG_MTD_PAGEDMAP_START; ---*/ /*--- dev->resource->end = dev->resource->start + CONFIG_MTD_PAGEDMAP_LEN; ---*/ printk("[%s, %u] \n", __FILE__, __LINE__); printk(/* KERN_NOTICE */ KERN_ERR "spimap platform flash device: %.8llx at %.8llx\n", (unsigned long long)dev->resource->end - dev->resource->start + 1, (unsigned long long)dev->resource->start); printk("[%s, %u] \n", __FILE__, __LINE__); info = kmalloc(sizeof(struct spimap_flash_info), GFP_KERNEL); if (info == NULL) { err = -ENOMEM; printk("[%s, %u] \n", __FILE__, __LINE__); goto err_out; } printk("[%s, %u] \n", __FILE__, __LINE__); memset(info, 0, sizeof(*info)); printk("[%s, %u] \n", __FILE__, __LINE__); platform_set_drvdata(dev, info); printk("[%s, %u] \n", __FILE__, __LINE__); #if 0 info->res = request_mem_region(CONFIG_MTD_PAGEDMAP_START, CONFIG_MTD_PAGEDMAP_LEN, dev->dev.bus_id); /*--- info->res = request_mem_region(dev->resource->start, ---*/ /*--- dev->resource->end - dev->resource->start + 1, ---*/ /*--- dev->dev.bus_id); ---*/ if (info->res == NULL) { dev_err(&dev->dev, "Could not reserve memory region\n"); err = -ENOMEM; goto err_out; } #endif printk("[%s, %u] \n", __FILE__, __LINE__); info->map.name = dev->dev.bus_id; printk("info->map.name = %s\n", info->map.name); info->map.phys = dev->resource->start; info->map.size = dev->resource->end - dev->resource->start + 1; info->map.bankwidth = spimap_data->width; info->map.set_vpp = spimap_data->set_vpp; #if 0 info->map.virt = ioremap(CONFIG_MTD_PAGEDMAP_START, CONFIG_MTD_PAGEDMAP_LEN); if (info->map.virt == NULL) { dev_err(&dev->dev, "Failed to ioremap flash region\n"); err = EIO; goto err_out; } #endif printk("[%s, %u] \n", __FILE__, __LINE__); /*--- simple_map_init(&info->map); ---*/ printk("[%s, %u] \n", __FILE__, __LINE__); probe_type = rom_probe_types; for (; info->mtd == NULL && *probe_type != NULL; probe_type++) info->mtd = do_map_probe(*probe_type, &info->map); if (info->mtd == NULL) { dev_err(&dev->dev, "map_probe failed\n"); err = -ENXIO; goto err_out; } info->mtd->owner = THIS_MODULE; printk("[%s, %u] \n", __FILE__, __LINE__); #ifdef CONFIG_MTD_PARTITIONS err = parse_mtd_partitions(info->mtd, part_probe_types, &info->parts, 0); if (err > 0) { add_mtd_partitions(info->mtd, info->parts, err); return 0; } if (spimap_data->probes) { err = parse_mtd_partitions(info->mtd, spimap_data->probes, &info->parts, 0); if (err > 0) { add_mtd_partitions(info->mtd, info->parts, err); return 0; } } printk("[%s, %u] \n", __FILE__, __LINE__); if (spimap_data->nr_parts) { printk(KERN_NOTICE "Using spimap partition information\n"); add_mtd_partitions(info->mtd, spimap_data->parts, spimap_data->nr_parts); return 0; } #endif printk("[%s, %u] \n", __FILE__, __LINE__); add_mtd_device(info->mtd); return 0; err_out: spimap_flash_remove(dev); return err; } #ifdef CONFIG_PM static int spimap_flash_suspend(struct platform_device *dev, pm_message_t state) { struct spimap_flash_info *info = platform_get_drvdata(dev); int ret = 0; if (info) ret = info->mtd->suspend(info->mtd); return ret; } static int spimap_flash_resume(struct platform_device *dev) { struct spimap_flash_info *info = platform_get_drvdata(dev); if (info) info->mtd->resume(info->mtd); return 0; } static void spimap_flash_shutdown(struct platform_device *dev) { struct spimap_flash_info *info = platform_get_drvdata(dev); if (info && info->mtd->suspend(info->mtd) == 0) info->mtd->resume(info->mtd); } #endif static struct platform_driver spimap_flash_driver = { .probe = spimap_flash_probe, .remove = spimap_flash_remove, #ifdef CONFIG_PM .suspend = spimap_flash_suspend, .resume = spimap_flash_resume, .shutdown = spimap_flash_shutdown, #endif .driver = { .name = "spimap-flash", }, }; #ifdef CONFIG_MTD_PAGEDMAP_LEN #if CONFIG_MTD_PAGEDMAP_LEN != 0 #ifndef CONFIG_ARCH_DAVINCI #warnig using PAGEDMAP compat code #error using PAGEDMAP compat code #define PAGEDMAP_COMPAT #endif /*--- #ifndef CONFIG_ARCH_DAVINCI ---*/ #endif #endif #ifdef PAGEDMAP_COMPAT static struct pagedmap_flash_data spimap_flash_data = { .width = CONFIG_MTD_PAGEDMAP_BANKWIDTH, }; static struct resource spimap_flash_resource = { .start = CONFIG_MTD_PAGEDMAP_START, .end = CONFIG_MTD_PAGEDMAP_START + CONFIG_MTD_PAGEDMAP_LEN - 1, .flags = IORESOURCE_MEM, }; static struct platform_device spimap_flash = { .name = "spimap-flash", .id = 0, .dev = { .platform_data = &spimap_flash_data, }, .num_resources = 1, .resource = &spimap_flash_resource, }; void spimap_configure(unsigned long addr, unsigned long size, int bankwidth, void (*set_vpp)(struct map_info *, int)) { spimap_flash_resource.start = addr; spimap_flash_resource.end = addr + size - 1; spimap_flash_data.width = bankwidth; spimap_flash_data.set_vpp = set_vpp; } #ifdef CONFIG_MTD_PARTITIONS void spimap_set_partitions(struct mtd_partition *parts, int num_parts) { spimap_flash_data.nr_parts = num_parts; spimap_flash_data.parts = parts; } #endif #endif static int __init spimap_init(void) { int err; err = platform_driver_register(&spimap_flash_driver); #ifdef PAGEDMAP_COMPAT if (err == 0) platform_device_register(&spimap_flash); #endif return err; } static void __exit spimap_exit(void) { #ifdef PAGEDMAP_COMPAT platform_device_unregister(&spimap_flash); #endif platform_driver_unregister(&spimap_flash_driver); } module_init(spimap_init); module_exit(spimap_exit); MODULE_LICENSE("GPL"); MODULE_AUTHOR("David Woodhouse , Martin Pommmerenke , Haiko Schillert "); MODULE_DESCRIPTION("Generic configurable MTD map driver for spi flash");