diff options
Diffstat (limited to 'drivers/mtd/devices')
-rw-r--r-- | drivers/mtd/devices/mtdram.c | 265 |
1 files changed, 96 insertions, 169 deletions
diff --git a/drivers/mtd/devices/mtdram.c b/drivers/mtd/devices/mtdram.c index edac4156d69c..bb713fed2f37 100644 --- a/drivers/mtd/devices/mtdram.c +++ b/drivers/mtd/devices/mtdram.c | |||
@@ -1,9 +1,10 @@ | |||
1 | /* | 1 | /* |
2 | * mtdram - a test mtd device | 2 | * mtdram - a test mtd device |
3 | * $Id: mtdram.c,v 1.35 2005/01/05 18:05:12 dwmw2 Exp $ | 3 | * $Id: mtdram.c,v 1.37 2005/04/21 03:42:11 joern Exp $ |
4 | * Author: Alexander Larsson <alex@cendio.se> | 4 | * Author: Alexander Larsson <alex@cendio.se> |
5 | * | 5 | * |
6 | * Copyright (c) 1999 Alexander Larsson <alex@cendio.se> | 6 | * Copyright (c) 1999 Alexander Larsson <alex@cendio.se> |
7 | * Copyright (c) 2005 Joern Engel <joern@wh.fh-wedel.de> | ||
7 | * | 8 | * |
8 | * This code is GPL | 9 | * This code is GPL |
9 | * | 10 | * |
@@ -18,213 +19,140 @@ | |||
18 | #include <linux/mtd/compatmac.h> | 19 | #include <linux/mtd/compatmac.h> |
19 | #include <linux/mtd/mtd.h> | 20 | #include <linux/mtd/mtd.h> |
20 | 21 | ||
21 | #ifndef CONFIG_MTDRAM_ABS_POS | ||
22 | #define CONFIG_MTDRAM_ABS_POS 0 | ||
23 | #endif | ||
24 | |||
25 | #if CONFIG_MTDRAM_ABS_POS > 0 | ||
26 | #include <asm/io.h> | ||
27 | #endif | ||
28 | |||
29 | #ifdef MODULE | ||
30 | static unsigned long total_size = CONFIG_MTDRAM_TOTAL_SIZE; | 22 | static unsigned long total_size = CONFIG_MTDRAM_TOTAL_SIZE; |
31 | static unsigned long erase_size = CONFIG_MTDRAM_ERASE_SIZE; | 23 | static unsigned long erase_size = CONFIG_MTDRAM_ERASE_SIZE; |
32 | module_param(total_size,ulong,0); | ||
33 | MODULE_PARM_DESC(total_size, "Total device size in KiB"); | ||
34 | module_param(erase_size,ulong,0); | ||
35 | MODULE_PARM_DESC(erase_size, "Device erase block size in KiB"); | ||
36 | #define MTDRAM_TOTAL_SIZE (total_size * 1024) | 24 | #define MTDRAM_TOTAL_SIZE (total_size * 1024) |
37 | #define MTDRAM_ERASE_SIZE (erase_size * 1024) | 25 | #define MTDRAM_ERASE_SIZE (erase_size * 1024) |
38 | #else | ||
39 | #define MTDRAM_TOTAL_SIZE (CONFIG_MTDRAM_TOTAL_SIZE * 1024) | ||
40 | #define MTDRAM_ERASE_SIZE (CONFIG_MTDRAM_ERASE_SIZE * 1024) | ||
41 | #endif | ||
42 | 26 | ||
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 | ||
43 | 33 | ||
44 | // We could store these in the mtd structure, but we only support 1 device.. | 34 | // We could store these in the mtd structure, but we only support 1 device.. |
45 | static struct mtd_info *mtd_info; | 35 | static struct mtd_info *mtd_info; |
46 | 36 | ||
47 | 37 | static int ram_erase(struct mtd_info *mtd, struct erase_info *instr) | |
48 | static int | ||
49 | ram_erase(struct mtd_info *mtd, struct erase_info *instr) | ||
50 | { | 38 | { |
51 | DEBUG(MTD_DEBUG_LEVEL2, "ram_erase(pos:%ld, len:%ld)\n", (long)instr->addr, (long)instr->len); | 39 | if (instr->addr + instr->len > mtd->size) |
52 | if (instr->addr + instr->len > mtd->size) { | 40 | return -EINVAL; |
53 | DEBUG(MTD_DEBUG_LEVEL1, "ram_erase() out of bounds (%ld > %ld)\n", (long)(instr->addr + instr->len), (long)mtd->size); | 41 | |
54 | return -EINVAL; | 42 | memset((char *)mtd->priv + instr->addr, 0xff, instr->len); |
55 | } | 43 | |
56 | 44 | instr->state = MTD_ERASE_DONE; | |
57 | memset((char *)mtd->priv + instr->addr, 0xff, instr->len); | 45 | mtd_erase_callback(instr); |
58 | 46 | ||
59 | instr->state = MTD_ERASE_DONE; | 47 | return 0; |
60 | mtd_erase_callback(instr); | ||
61 | |||
62 | return 0; | ||
63 | } | 48 | } |
64 | 49 | ||
65 | static int ram_point (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char **mtdbuf) | 50 | static int ram_point(struct mtd_info *mtd, loff_t from, size_t len, |
51 | size_t *retlen, u_char **mtdbuf) | ||
66 | { | 52 | { |
67 | if (from + len > mtd->size) | 53 | if (from + len > mtd->size) |
68 | return -EINVAL; | 54 | return -EINVAL; |
69 | 55 | ||
70 | *mtdbuf = mtd->priv + from; | 56 | *mtdbuf = mtd->priv + from; |
71 | *retlen = len; | 57 | *retlen = len; |
72 | return 0; | 58 | return 0; |
73 | } | 59 | } |
74 | 60 | ||
75 | static void ram_unpoint (struct mtd_info *mtd, u_char *addr, loff_t from, | 61 | static void ram_unpoint(struct mtd_info *mtd, u_char * addr, loff_t from, |
76 | size_t len) | 62 | size_t len) |
77 | { | 63 | { |
78 | DEBUG(MTD_DEBUG_LEVEL2, "ram_unpoint\n"); | ||
79 | } | 64 | } |
80 | 65 | ||
81 | static int ram_read(struct mtd_info *mtd, loff_t from, size_t len, | 66 | static int ram_read(struct mtd_info *mtd, loff_t from, size_t len, |
82 | size_t *retlen, u_char *buf) | 67 | size_t *retlen, u_char *buf) |
83 | { | 68 | { |
84 | DEBUG(MTD_DEBUG_LEVEL2, "ram_read(pos:%ld, len:%ld)\n", (long)from, (long)len); | 69 | if (from + len > mtd->size) |
85 | if (from + len > mtd->size) { | 70 | return -EINVAL; |
86 | DEBUG(MTD_DEBUG_LEVEL1, "ram_read() out of bounds (%ld > %ld)\n", (long)(from + len), (long)mtd->size); | ||
87 | return -EINVAL; | ||
88 | } | ||
89 | 71 | ||
90 | memcpy(buf, mtd->priv + from, len); | 72 | memcpy(buf, mtd->priv + from, len); |
91 | 73 | ||
92 | *retlen=len; | 74 | *retlen = len; |
93 | return 0; | 75 | return 0; |
94 | } | 76 | } |
95 | 77 | ||
96 | static int ram_write(struct mtd_info *mtd, loff_t to, size_t len, | 78 | static int ram_write(struct mtd_info *mtd, loff_t to, size_t len, |
97 | size_t *retlen, const u_char *buf) | 79 | size_t *retlen, const u_char *buf) |
98 | { | 80 | { |
99 | DEBUG(MTD_DEBUG_LEVEL2, "ram_write(pos:%ld, len:%ld)\n", (long)to, (long)len); | 81 | if (to + len > mtd->size) |
100 | if (to + len > mtd->size) { | 82 | return -EINVAL; |
101 | DEBUG(MTD_DEBUG_LEVEL1, "ram_write() out of bounds (%ld > %ld)\n", (long)(to + len), (long)mtd->size); | ||
102 | return -EINVAL; | ||
103 | } | ||
104 | 83 | ||
105 | memcpy ((char *)mtd->priv + to, buf, len); | 84 | memcpy((char *)mtd->priv + to, buf, len); |
106 | 85 | ||
107 | *retlen=len; | 86 | *retlen = len; |
108 | return 0; | 87 | return 0; |
109 | } | 88 | } |
110 | 89 | ||
111 | static void __exit cleanup_mtdram(void) | 90 | static void __exit cleanup_mtdram(void) |
112 | { | 91 | { |
113 | if (mtd_info) { | 92 | if (mtd_info) { |
114 | del_mtd_device(mtd_info); | 93 | del_mtd_device(mtd_info); |
115 | #if CONFIG_MTDRAM_TOTAL_SIZE > 0 | 94 | if (mtd_info->priv) |
116 | if (mtd_info->priv) | 95 | vfree(mtd_info->priv); |
117 | #if CONFIG_MTDRAM_ABS_POS > 0 | 96 | kfree(mtd_info); |
118 | iounmap(mtd_info->priv); | 97 | } |
119 | #else | ||
120 | vfree(mtd_info->priv); | ||
121 | #endif | ||
122 | #endif | ||
123 | kfree(mtd_info); | ||
124 | } | ||
125 | } | ||
126 | |||
127 | int mtdram_init_device(struct mtd_info *mtd, void *mapped_address, | ||
128 | unsigned long size, char *name) | ||
129 | { | ||
130 | memset(mtd, 0, sizeof(*mtd)); | ||
131 | |||
132 | /* Setup the MTD structure */ | ||
133 | mtd->name = name; | ||
134 | mtd->type = MTD_RAM; | ||
135 | mtd->flags = MTD_CAP_RAM; | ||
136 | mtd->size = size; | ||
137 | mtd->erasesize = MTDRAM_ERASE_SIZE; | ||
138 | mtd->priv = mapped_address; | ||
139 | |||
140 | mtd->owner = THIS_MODULE; | ||
141 | mtd->erase = ram_erase; | ||
142 | mtd->point = ram_point; | ||
143 | mtd->unpoint = ram_unpoint; | ||
144 | mtd->read = ram_read; | ||
145 | mtd->write = ram_write; | ||
146 | |||
147 | if (add_mtd_device(mtd)) { | ||
148 | return -EIO; | ||
149 | } | ||
150 | |||
151 | return 0; | ||
152 | } | ||
153 | |||
154 | #if CONFIG_MTDRAM_TOTAL_SIZE > 0 | ||
155 | #if CONFIG_MTDRAM_ABS_POS > 0 | ||
156 | static int __init init_mtdram(void) | ||
157 | { | ||
158 | void *addr; | ||
159 | int err; | ||
160 | /* Allocate some memory */ | ||
161 | mtd_info = kmalloc(sizeof(struct mtd_info), GFP_KERNEL); | ||
162 | if (!mtd_info) | ||
163 | return -ENOMEM; | ||
164 | |||
165 | addr = ioremap(CONFIG_MTDRAM_ABS_POS, MTDRAM_TOTAL_SIZE); | ||
166 | if (!addr) { | ||
167 | DEBUG(MTD_DEBUG_LEVEL1, | ||
168 | "Failed to ioremap) memory region of size %ld at ABS_POS:%ld\n", | ||
169 | (long)MTDRAM_TOTAL_SIZE, (long)CONFIG_MTDRAM_ABS_POS); | ||
170 | kfree(mtd_info); | ||
171 | mtd_info = NULL; | ||
172 | return -ENOMEM; | ||
173 | } | ||
174 | err = mtdram_init_device(mtd_info, addr, | ||
175 | MTDRAM_TOTAL_SIZE, "mtdram test device"); | ||
176 | if (err) | ||
177 | { | ||
178 | iounmap(addr); | ||
179 | kfree(mtd_info); | ||
180 | mtd_info = NULL; | ||
181 | return err; | ||
182 | } | ||
183 | memset(mtd_info->priv, 0xff, MTDRAM_TOTAL_SIZE); | ||
184 | return err; | ||
185 | } | 98 | } |
186 | 99 | ||
187 | #else /* CONFIG_MTDRAM_ABS_POS > 0 */ | 100 | int mtdram_init_device(struct mtd_info *mtd, void *mapped_address, |
188 | 101 | unsigned long size, char *name) | |
189 | static int __init init_mtdram(void) | ||
190 | { | 102 | { |
191 | void *addr; | 103 | memset(mtd, 0, sizeof(*mtd)); |
192 | int err; | 104 | |
193 | /* Allocate some memory */ | 105 | /* Setup the MTD structure */ |
194 | mtd_info = kmalloc(sizeof(struct mtd_info), GFP_KERNEL); | 106 | mtd->name = name; |
195 | if (!mtd_info) | 107 | mtd->type = MTD_RAM; |
196 | return -ENOMEM; | 108 | mtd->flags = MTD_CAP_RAM; |
197 | 109 | mtd->size = size; | |
198 | addr = vmalloc(MTDRAM_TOTAL_SIZE); | 110 | mtd->erasesize = MTDRAM_ERASE_SIZE; |
199 | if (!addr) { | 111 | mtd->priv = mapped_address; |
200 | DEBUG(MTD_DEBUG_LEVEL1, | 112 | |
201 | "Failed to vmalloc memory region of size %ld\n", | 113 | mtd->owner = THIS_MODULE; |
202 | (long)MTDRAM_TOTAL_SIZE); | 114 | mtd->erase = ram_erase; |
203 | kfree(mtd_info); | 115 | mtd->point = ram_point; |
204 | mtd_info = NULL; | 116 | mtd->unpoint = ram_unpoint; |
205 | return -ENOMEM; | 117 | mtd->read = ram_read; |
206 | } | 118 | mtd->write = ram_write; |
207 | err = mtdram_init_device(mtd_info, addr, | 119 | |
208 | MTDRAM_TOTAL_SIZE, "mtdram test device"); | 120 | if (add_mtd_device(mtd)) { |
209 | if (err) | 121 | return -EIO; |
210 | { | 122 | } |
211 | vfree(addr); | 123 | |
212 | kfree(mtd_info); | 124 | return 0; |
213 | mtd_info = NULL; | ||
214 | return err; | ||
215 | } | ||
216 | memset(mtd_info->priv, 0xff, MTDRAM_TOTAL_SIZE); | ||
217 | return err; | ||
218 | } | 125 | } |
219 | #endif /* !(CONFIG_MTDRAM_ABS_POS > 0) */ | ||
220 | |||
221 | #else /* CONFIG_MTDRAM_TOTAL_SIZE > 0 */ | ||
222 | 126 | ||
223 | static int __init init_mtdram(void) | 127 | static int __init init_mtdram(void) |
224 | { | 128 | { |
225 | return 0; | 129 | void *addr; |
130 | int err; | ||
131 | |||
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; | ||
226 | } | 155 | } |
227 | #endif /* !(CONFIG_MTDRAM_TOTAL_SIZE > 0) */ | ||
228 | 156 | ||
229 | module_init(init_mtdram); | 157 | module_init(init_mtdram); |
230 | module_exit(cleanup_mtdram); | 158 | module_exit(cleanup_mtdram); |
@@ -232,4 +160,3 @@ module_exit(cleanup_mtdram); | |||
232 | MODULE_LICENSE("GPL"); | 160 | MODULE_LICENSE("GPL"); |
233 | MODULE_AUTHOR("Alexander Larsson <alexl@redhat.com>"); | 161 | MODULE_AUTHOR("Alexander Larsson <alexl@redhat.com>"); |
234 | MODULE_DESCRIPTION("Simulated MTD driver for testing"); | 162 | MODULE_DESCRIPTION("Simulated MTD driver for testing"); |
235 | |||