diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/mtd/devices/phram.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/mtd/devices/phram.c')
-rw-r--r-- | drivers/mtd/devices/phram.c | 285 |
1 files changed, 285 insertions, 0 deletions
diff --git a/drivers/mtd/devices/phram.c b/drivers/mtd/devices/phram.c new file mode 100644 index 000000000000..5f8e164ddb71 --- /dev/null +++ b/drivers/mtd/devices/phram.c | |||
@@ -0,0 +1,285 @@ | |||
1 | /** | ||
2 | * $Id: phram.c,v 1.11 2005/01/05 18:05:13 dwmw2 Exp $ | ||
3 | * | ||
4 | * Copyright (c) ???? Jochen Schäuble <psionic@psionic.de> | ||
5 | * Copyright (c) 2003-2004 Jörn Engel <joern@wh.fh-wedel.de> | ||
6 | * | ||
7 | * Usage: | ||
8 | * | ||
9 | * one commend line parameter per device, each in the form: | ||
10 | * phram=<name>,<start>,<len> | ||
11 | * <name> may be up to 63 characters. | ||
12 | * <start> and <len> can be octal, decimal or hexadecimal. If followed | ||
13 | * by "ki", "Mi" or "Gi", the numbers will be interpreted as kilo, mega or | ||
14 | * gigabytes. | ||
15 | * | ||
16 | * Example: | ||
17 | * phram=swap,64Mi,128Mi phram=test,900Mi,1Mi | ||
18 | * | ||
19 | */ | ||
20 | |||
21 | #include <asm/io.h> | ||
22 | #include <linux/init.h> | ||
23 | #include <linux/kernel.h> | ||
24 | #include <linux/list.h> | ||
25 | #include <linux/module.h> | ||
26 | #include <linux/moduleparam.h> | ||
27 | #include <linux/mtd/mtd.h> | ||
28 | |||
29 | #define ERROR(fmt, args...) printk(KERN_ERR "phram: " fmt , ## args) | ||
30 | |||
31 | struct phram_mtd_list { | ||
32 | struct mtd_info mtd; | ||
33 | struct list_head list; | ||
34 | }; | ||
35 | |||
36 | static LIST_HEAD(phram_list); | ||
37 | |||
38 | |||
39 | |||
40 | static int phram_erase(struct mtd_info *mtd, struct erase_info *instr) | ||
41 | { | ||
42 | u_char *start = mtd->priv; | ||
43 | |||
44 | if (instr->addr + instr->len > mtd->size) | ||
45 | return -EINVAL; | ||
46 | |||
47 | memset(start + instr->addr, 0xff, instr->len); | ||
48 | |||
49 | /* This'll catch a few races. Free the thing before returning :) | ||
50 | * I don't feel at all ashamed. This kind of thing is possible anyway | ||
51 | * with flash, but unlikely. | ||
52 | */ | ||
53 | |||
54 | instr->state = MTD_ERASE_DONE; | ||
55 | |||
56 | mtd_erase_callback(instr); | ||
57 | |||
58 | return 0; | ||
59 | } | ||
60 | |||
61 | static int phram_point(struct mtd_info *mtd, loff_t from, size_t len, | ||
62 | size_t *retlen, u_char **mtdbuf) | ||
63 | { | ||
64 | u_char *start = mtd->priv; | ||
65 | |||
66 | if (from + len > mtd->size) | ||
67 | return -EINVAL; | ||
68 | |||
69 | *mtdbuf = start + from; | ||
70 | *retlen = len; | ||
71 | return 0; | ||
72 | } | ||
73 | |||
74 | static void phram_unpoint(struct mtd_info *mtd, u_char *addr, loff_t from, size_t len) | ||
75 | { | ||
76 | } | ||
77 | |||
78 | static int phram_read(struct mtd_info *mtd, loff_t from, size_t len, | ||
79 | size_t *retlen, u_char *buf) | ||
80 | { | ||
81 | u_char *start = mtd->priv; | ||
82 | |||
83 | if (from + len > mtd->size) | ||
84 | return -EINVAL; | ||
85 | |||
86 | memcpy(buf, start + from, len); | ||
87 | |||
88 | *retlen = len; | ||
89 | return 0; | ||
90 | } | ||
91 | |||
92 | static int phram_write(struct mtd_info *mtd, loff_t to, size_t len, | ||
93 | size_t *retlen, const u_char *buf) | ||
94 | { | ||
95 | u_char *start = mtd->priv; | ||
96 | |||
97 | if (to + len > mtd->size) | ||
98 | return -EINVAL; | ||
99 | |||
100 | memcpy(start + to, buf, len); | ||
101 | |||
102 | *retlen = len; | ||
103 | return 0; | ||
104 | } | ||
105 | |||
106 | |||
107 | |||
108 | static void unregister_devices(void) | ||
109 | { | ||
110 | struct phram_mtd_list *this; | ||
111 | |||
112 | list_for_each_entry(this, &phram_list, list) { | ||
113 | del_mtd_device(&this->mtd); | ||
114 | iounmap(this->mtd.priv); | ||
115 | kfree(this); | ||
116 | } | ||
117 | } | ||
118 | |||
119 | static int register_device(char *name, unsigned long start, unsigned long len) | ||
120 | { | ||
121 | struct phram_mtd_list *new; | ||
122 | int ret = -ENOMEM; | ||
123 | |||
124 | new = kmalloc(sizeof(*new), GFP_KERNEL); | ||
125 | if (!new) | ||
126 | goto out0; | ||
127 | |||
128 | memset(new, 0, sizeof(*new)); | ||
129 | |||
130 | ret = -EIO; | ||
131 | new->mtd.priv = ioremap(start, len); | ||
132 | if (!new->mtd.priv) { | ||
133 | ERROR("ioremap failed\n"); | ||
134 | goto out1; | ||
135 | } | ||
136 | |||
137 | |||
138 | new->mtd.name = name; | ||
139 | new->mtd.size = len; | ||
140 | new->mtd.flags = MTD_CAP_RAM | MTD_ERASEABLE | MTD_VOLATILE; | ||
141 | new->mtd.erase = phram_erase; | ||
142 | new->mtd.point = phram_point; | ||
143 | new->mtd.unpoint = phram_unpoint; | ||
144 | new->mtd.read = phram_read; | ||
145 | new->mtd.write = phram_write; | ||
146 | new->mtd.owner = THIS_MODULE; | ||
147 | new->mtd.type = MTD_RAM; | ||
148 | new->mtd.erasesize = 0; | ||
149 | |||
150 | ret = -EAGAIN; | ||
151 | if (add_mtd_device(&new->mtd)) { | ||
152 | ERROR("Failed to register new device\n"); | ||
153 | goto out2; | ||
154 | } | ||
155 | |||
156 | list_add_tail(&new->list, &phram_list); | ||
157 | return 0; | ||
158 | |||
159 | out2: | ||
160 | iounmap(new->mtd.priv); | ||
161 | out1: | ||
162 | kfree(new); | ||
163 | out0: | ||
164 | return ret; | ||
165 | } | ||
166 | |||
167 | static int ustrtoul(const char *cp, char **endp, unsigned int base) | ||
168 | { | ||
169 | unsigned long result = simple_strtoul(cp, endp, base); | ||
170 | |||
171 | switch (**endp) { | ||
172 | case 'G': | ||
173 | result *= 1024; | ||
174 | case 'M': | ||
175 | result *= 1024; | ||
176 | case 'k': | ||
177 | result *= 1024; | ||
178 | /* By dwmw2 editorial decree, "ki", "Mi" or "Gi" are to be used. */ | ||
179 | if ((*endp)[1] == 'i') | ||
180 | (*endp) += 2; | ||
181 | } | ||
182 | return result; | ||
183 | } | ||
184 | |||
185 | static int parse_num32(uint32_t *num32, const char *token) | ||
186 | { | ||
187 | char *endp; | ||
188 | unsigned long n; | ||
189 | |||
190 | n = ustrtoul(token, &endp, 0); | ||
191 | if (*endp) | ||
192 | return -EINVAL; | ||
193 | |||
194 | *num32 = n; | ||
195 | return 0; | ||
196 | } | ||
197 | |||
198 | static int parse_name(char **pname, const char *token) | ||
199 | { | ||
200 | size_t len; | ||
201 | char *name; | ||
202 | |||
203 | len = strlen(token) + 1; | ||
204 | if (len > 64) | ||
205 | return -ENOSPC; | ||
206 | |||
207 | name = kmalloc(len, GFP_KERNEL); | ||
208 | if (!name) | ||
209 | return -ENOMEM; | ||
210 | |||
211 | strcpy(name, token); | ||
212 | |||
213 | *pname = name; | ||
214 | return 0; | ||
215 | } | ||
216 | |||
217 | #define parse_err(fmt, args...) do { \ | ||
218 | ERROR(fmt , ## args); \ | ||
219 | return 0; \ | ||
220 | } while (0) | ||
221 | |||
222 | static int phram_setup(const char *val, struct kernel_param *kp) | ||
223 | { | ||
224 | char buf[64+12+12], *str = buf; | ||
225 | char *token[3]; | ||
226 | char *name; | ||
227 | uint32_t start; | ||
228 | uint32_t len; | ||
229 | int i, ret; | ||
230 | |||
231 | if (strnlen(val, sizeof(buf)) >= sizeof(buf)) | ||
232 | parse_err("parameter too long\n"); | ||
233 | |||
234 | strcpy(str, val); | ||
235 | |||
236 | for (i=0; i<3; i++) | ||
237 | token[i] = strsep(&str, ","); | ||
238 | |||
239 | if (str) | ||
240 | parse_err("too many arguments\n"); | ||
241 | |||
242 | if (!token[2]) | ||
243 | parse_err("not enough arguments\n"); | ||
244 | |||
245 | ret = parse_name(&name, token[0]); | ||
246 | if (ret == -ENOMEM) | ||
247 | parse_err("out of memory\n"); | ||
248 | if (ret == -ENOSPC) | ||
249 | parse_err("name too long\n"); | ||
250 | if (ret) | ||
251 | return 0; | ||
252 | |||
253 | ret = parse_num32(&start, token[1]); | ||
254 | if (ret) | ||
255 | parse_err("illegal start address\n"); | ||
256 | |||
257 | ret = parse_num32(&len, token[2]); | ||
258 | if (ret) | ||
259 | parse_err("illegal device length\n"); | ||
260 | |||
261 | register_device(name, start, len); | ||
262 | |||
263 | return 0; | ||
264 | } | ||
265 | |||
266 | module_param_call(phram, phram_setup, NULL, NULL, 000); | ||
267 | MODULE_PARM_DESC(phram,"Memory region to map. \"map=<name>,<start>,<length>\""); | ||
268 | |||
269 | |||
270 | static int __init init_phram(void) | ||
271 | { | ||
272 | return 0; | ||
273 | } | ||
274 | |||
275 | static void __exit cleanup_phram(void) | ||
276 | { | ||
277 | unregister_devices(); | ||
278 | } | ||
279 | |||
280 | module_init(init_phram); | ||
281 | module_exit(cleanup_phram); | ||
282 | |||
283 | MODULE_LICENSE("GPL"); | ||
284 | MODULE_AUTHOR("Jörn Engel <joern@wh.fh-wedel.de>"); | ||
285 | MODULE_DESCRIPTION("MTD driver for physical RAM"); | ||