Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * mtdram - a test mtd device |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 3 | * $Id: mtdram.c,v 1.37 2005/04/21 03:42:11 joern Exp $ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | * Author: Alexander Larsson <alex@cendio.se> |
| 5 | * |
| 6 | * Copyright (c) 1999 Alexander Larsson <alex@cendio.se> |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 7 | * Copyright (c) 2005 Joern Engel <joern@wh.fh-wedel.de> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | * |
| 9 | * This code is GPL |
| 10 | * |
| 11 | */ |
| 12 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | #include <linux/module.h> |
| 14 | #include <linux/slab.h> |
| 15 | #include <linux/ioport.h> |
| 16 | #include <linux/vmalloc.h> |
| 17 | #include <linux/init.h> |
| 18 | #include <linux/mtd/compatmac.h> |
| 19 | #include <linux/mtd/mtd.h> |
Adrian Bunk | 456d9fc | 2008-04-14 17:20:02 +0300 | [diff] [blame] | 20 | #include <linux/mtd/mtdram.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | static unsigned long total_size = CONFIG_MTDRAM_TOTAL_SIZE; |
| 23 | static unsigned long erase_size = CONFIG_MTDRAM_ERASE_SIZE; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | #define MTDRAM_TOTAL_SIZE (total_size * 1024) |
| 25 | #define MTDRAM_ERASE_SIZE (erase_size * 1024) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 27 | #ifdef MODULE |
| 28 | module_param(total_size, ulong, 0); |
| 29 | MODULE_PARM_DESC(total_size, "Total device size in KiB"); |
| 30 | module_param(erase_size, ulong, 0); |
| 31 | MODULE_PARM_DESC(erase_size, "Device erase block size in KiB"); |
| 32 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | |
| 34 | // We could store these in the mtd structure, but we only support 1 device.. |
| 35 | static struct mtd_info *mtd_info; |
| 36 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 37 | static int ram_erase(struct mtd_info *mtd, struct erase_info *instr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 39 | if (instr->addr + instr->len > mtd->size) |
| 40 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 42 | memset((char *)mtd->priv + instr->addr, 0xff, instr->len); |
| 43 | |
| 44 | instr->state = MTD_ERASE_DONE; |
| 45 | mtd_erase_callback(instr); |
| 46 | |
| 47 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | } |
| 49 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 50 | static int ram_point(struct mtd_info *mtd, loff_t from, size_t len, |
| 51 | size_t *retlen, u_char **mtdbuf) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 53 | if (from + len > mtd->size) |
| 54 | return -EINVAL; |
| 55 | |
| 56 | *mtdbuf = mtd->priv + from; |
| 57 | *retlen = len; |
| 58 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | } |
| 60 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 61 | static void ram_unpoint(struct mtd_info *mtd, u_char * addr, loff_t from, |
| 62 | size_t len) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | } |
| 65 | |
| 66 | static int ram_read(struct mtd_info *mtd, loff_t from, size_t len, |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 67 | size_t *retlen, u_char *buf) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 69 | if (from + len > mtd->size) |
| 70 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 72 | memcpy(buf, mtd->priv + from, len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 74 | *retlen = len; |
| 75 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | } |
| 77 | |
| 78 | static int ram_write(struct mtd_info *mtd, loff_t to, size_t len, |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 79 | size_t *retlen, const u_char *buf) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 80 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 81 | if (to + len > mtd->size) |
| 82 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 84 | memcpy((char *)mtd->priv + to, buf, len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 86 | *retlen = len; |
| 87 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | } |
| 89 | |
| 90 | static void __exit cleanup_mtdram(void) |
| 91 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 92 | if (mtd_info) { |
| 93 | del_mtd_device(mtd_info); |
Jesper Juhl | f9101210 | 2005-09-10 00:26:54 -0700 | [diff] [blame] | 94 | vfree(mtd_info->priv); |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 95 | kfree(mtd_info); |
| 96 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | } |
| 98 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 99 | int mtdram_init_device(struct mtd_info *mtd, void *mapped_address, |
| 100 | unsigned long size, char *name) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 102 | memset(mtd, 0, sizeof(*mtd)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 104 | /* Setup the MTD structure */ |
| 105 | mtd->name = name; |
David Woodhouse | 21c8db9 | 2006-06-14 21:39:48 +0100 | [diff] [blame] | 106 | mtd->type = MTD_RAM; |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 107 | mtd->flags = MTD_CAP_RAM; |
| 108 | mtd->size = size; |
Artem B. Bityutskiy | 783ed81 | 2006-06-14 19:53:44 +0400 | [diff] [blame] | 109 | mtd->writesize = 1; |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 110 | mtd->erasesize = MTDRAM_ERASE_SIZE; |
| 111 | mtd->priv = mapped_address; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 113 | mtd->owner = THIS_MODULE; |
| 114 | mtd->erase = ram_erase; |
| 115 | mtd->point = ram_point; |
| 116 | mtd->unpoint = ram_unpoint; |
| 117 | mtd->read = ram_read; |
| 118 | mtd->write = ram_write; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 120 | if (add_mtd_device(mtd)) { |
| 121 | return -EIO; |
| 122 | } |
| 123 | |
| 124 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | } |
| 126 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | static int __init init_mtdram(void) |
| 128 | { |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 129 | void *addr; |
| 130 | int err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | |
Joern Engel | c13cbf3 | 2005-04-21 04:42:15 +0100 | [diff] [blame] | 132 | if (!total_size) |
| 133 | return -EINVAL; |
| 134 | |
| 135 | /* Allocate some memory */ |
| 136 | mtd_info = kmalloc(sizeof(struct mtd_info), GFP_KERNEL); |
| 137 | if (!mtd_info) |
| 138 | return -ENOMEM; |
| 139 | |
| 140 | addr = vmalloc(MTDRAM_TOTAL_SIZE); |
| 141 | if (!addr) { |
| 142 | kfree(mtd_info); |
| 143 | mtd_info = NULL; |
| 144 | return -ENOMEM; |
| 145 | } |
| 146 | err = mtdram_init_device(mtd_info, addr, MTDRAM_TOTAL_SIZE, "mtdram test device"); |
| 147 | if (err) { |
| 148 | vfree(addr); |
| 149 | kfree(mtd_info); |
| 150 | mtd_info = NULL; |
| 151 | return err; |
| 152 | } |
| 153 | memset(mtd_info->priv, 0xff, MTDRAM_TOTAL_SIZE); |
| 154 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 156 | |
| 157 | module_init(init_mtdram); |
| 158 | module_exit(cleanup_mtdram); |
| 159 | |
| 160 | MODULE_LICENSE("GPL"); |
| 161 | MODULE_AUTHOR("Alexander Larsson <alexl@redhat.com>"); |
| 162 | MODULE_DESCRIPTION("Simulated MTD driver for testing"); |