138 lines · c
1/*2 * Copyright © 2001 Flaga hf. Medical Devices, Kári Davíðsson <kd@flaga.is>3 *4 * This program is free software; you can redistribute it and/or modify it5 * under the terms of the GNU General Public License as published by the6 * Free Software Foundation; either version 2 of the License, or (at your7 * option) any later version.8 *9 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED10 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF11 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN12 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,13 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT14 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF15 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON16 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT17 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF18 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.19 *20 * You should have received a copy of the GNU General Public License along21 * with this program; if not, write to the Free Software Foundation, Inc.,22 * 675 Mass Ave, Cambridge, MA 02139, USA.23 */24 25#include <linux/module.h>26#include <linux/types.h>27#include <linux/kernel.h>28#include <linux/init.h>29#include <asm/io.h>30#include <linux/mtd/mtd.h>31#include <linux/mtd/map.h>32#include <linux/mtd/partitions.h>33 34 35/* We split the flash chip up into four parts.36 * 1: bootloader first 128k (0x00000000 - 0x0001FFFF) size 0x02000037 * 2: kernel 640k (0x00020000 - 0x000BFFFF) size 0x0A000038 * 3: compressed 1536k root ramdisk (0x000C0000 - 0x0023FFFF) size 0x18000039 * 4: writeable diskpartition (jffs)(0x00240000 - 0x003FFFFF) size 0x1C000040 */41 42#define FLASH_PHYS_ADDR 0x4000000043#define FLASH_SIZE 0x40000044 45#define FLASH_PARTITION0_ADDR 0x0000000046#define FLASH_PARTITION0_SIZE 0x0002000047 48#define FLASH_PARTITION1_ADDR 0x0002000049#define FLASH_PARTITION1_SIZE 0x000A000050 51#define FLASH_PARTITION2_ADDR 0x000C000052#define FLASH_PARTITION2_SIZE 0x0018000053 54#define FLASH_PARTITION3_ADDR 0x0024000055#define FLASH_PARTITION3_SIZE 0x001C000056 57 58static struct map_info flagadm_map = {59 .name = "FlagaDM flash device",60 .size = FLASH_SIZE,61 .bankwidth = 2,62};63 64static const struct mtd_partition flagadm_parts[] = {65 {66 .name = "Bootloader",67 .offset = FLASH_PARTITION0_ADDR,68 .size = FLASH_PARTITION0_SIZE69 },70 {71 .name = "Kernel image",72 .offset = FLASH_PARTITION1_ADDR,73 .size = FLASH_PARTITION1_SIZE74 },75 {76 .name = "Initial ramdisk image",77 .offset = FLASH_PARTITION2_ADDR,78 .size = FLASH_PARTITION2_SIZE79 },80 {81 .name = "Persistent storage",82 .offset = FLASH_PARTITION3_ADDR,83 .size = FLASH_PARTITION3_SIZE84 }85};86 87#define PARTITION_COUNT ARRAY_SIZE(flagadm_parts)88 89static struct mtd_info *mymtd;90 91static int __init init_flagadm(void)92{93 printk(KERN_NOTICE "FlagaDM flash device: %x at %x\n",94 FLASH_SIZE, FLASH_PHYS_ADDR);95 96 flagadm_map.phys = FLASH_PHYS_ADDR;97 flagadm_map.virt = ioremap(FLASH_PHYS_ADDR,98 FLASH_SIZE);99 100 if (!flagadm_map.virt) {101 printk("Failed to ioremap\n");102 return -EIO;103 }104 105 simple_map_init(&flagadm_map);106 107 mymtd = do_map_probe("cfi_probe", &flagadm_map);108 if (mymtd) {109 mymtd->owner = THIS_MODULE;110 mtd_device_register(mymtd, flagadm_parts, PARTITION_COUNT);111 printk(KERN_NOTICE "FlagaDM flash device initialized\n");112 return 0;113 }114 115 iounmap((void __iomem *)flagadm_map.virt);116 return -ENXIO;117}118 119static void __exit cleanup_flagadm(void)120{121 if (mymtd) {122 mtd_device_unregister(mymtd);123 map_destroy(mymtd);124 }125 if (flagadm_map.virt) {126 iounmap((void __iomem *)flagadm_map.virt);127 flagadm_map.virt = NULL;128 }129}130 131module_init(init_flagadm);132module_exit(cleanup_flagadm);133 134 135MODULE_LICENSE("GPL");136MODULE_AUTHOR("Kári Davíðsson <kd@flaga.is>");137MODULE_DESCRIPTION("MTD map driver for Flaga digital module");138