4 #include <linux/module.h>
5 #include <asm/uaccess.h>
6 #include <linux/types.h>
7 #include <linux/kernel.h>
8 #include <linux/ptrace.h>
9 #include <linux/slab.h>
10 #include <linux/string.h>
11 #include <linux/timer.h>
12 #include <linux/major.h>
14 #include <linux/ioctl.h>
15 #include <linux/init.h>
17 #include <asm/system.h>
19 #include <linux/mtd/mtd.h>
21 #define SLRAM_MAX_DEVICES_PARAMS 6 /* 3 parameters / device */
22 #define SLRAM_BLK_SZ 0x4000
24 #define T(fmt, args...) printk(KERN_DEBUG fmt, ## args)
25 #define E(fmt, args...) printk(KERN_NOTICE fmt, ## args)
27 typedef struct slram_priv
{
32 typedef struct slram_mtd_list
{
33 struct mtd_info
*mtdinfo
;
34 struct slram_mtd_list
*next
;
38 static char *map
[SLRAM_MAX_DEVICES_PARAMS
];
40 module_param_array(map
, charp
, NULL
, 0);
41 MODULE_PARM_DESC(map
, "List of memory regions to map. \"map=<name>, <start>, <length / end>\"");
46 static slram_mtd_list_t
*slram_mtdlist
= NULL
;
48 static int slram_erase(struct mtd_info
*, struct erase_info
*);
49 static int slram_point(struct mtd_info
*, loff_t
, size_t, size_t *, void **,
51 static void slram_unpoint(struct mtd_info
*, loff_t
, size_t);
52 static int slram_read(struct mtd_info
*, loff_t
, size_t, size_t *, u_char
*);
53 static int slram_write(struct mtd_info
*, loff_t
, size_t, size_t *, const u_char
*);
55 static int slram_erase(struct mtd_info
*mtd
, struct erase_info
*instr
)
57 slram_priv_t
*priv
= mtd
->priv
;
59 if (instr
->addr
+ instr
->len
> mtd
->size
) {
63 memset(priv
->start
+ instr
->addr
, 0xff, instr
->len
);
65 /* This'll catch a few races. Free the thing before returning :)
66 * I don't feel at all ashamed. This kind of thing is possible anyway
67 * with flash, but unlikely.
70 instr
->state
= MTD_ERASE_DONE
;
72 mtd_erase_callback(instr
);
77 static int slram_point(struct mtd_info
*mtd
, loff_t from
, size_t len
,
78 size_t *retlen
, void **virt
, resource_size_t
*phys
)
80 slram_priv_t
*priv
= mtd
->priv
;
82 /* can we return a physical address with this driver? */
86 if (from
+ len
> mtd
->size
)
89 *virt
= priv
->start
+ from
;
94 static void slram_unpoint(struct mtd_info
*mtd
, loff_t from
, size_t len
)
98 static int slram_read(struct mtd_info
*mtd
, loff_t from
, size_t len
,
99 size_t *retlen
, u_char
*buf
)
101 slram_priv_t
*priv
= mtd
->priv
;
103 if (from
> mtd
->size
)
106 if (from
+ len
> mtd
->size
)
107 len
= mtd
->size
- from
;
109 memcpy(buf
, priv
->start
+ from
, len
);
115 static int slram_write(struct mtd_info
*mtd
, loff_t to
, size_t len
,
116 size_t *retlen
, const u_char
*buf
)
118 slram_priv_t
*priv
= mtd
->priv
;
120 if (to
+ len
> mtd
->size
)
123 memcpy(priv
->start
+ to
, buf
, len
);
129 /*====================================================================*/
131 static int register_device(char *name
, unsigned long start
, unsigned long length
)
133 slram_mtd_list_t
**curmtd
;
135 curmtd
= &slram_mtdlist
;
137 curmtd
= &(*curmtd
)->next
;
140 *curmtd
= kmalloc(sizeof(slram_mtd_list_t
), GFP_KERNEL
);
142 E("slram: Cannot allocate new MTD device.\n");
145 (*curmtd
)->mtdinfo
= kzalloc(sizeof(struct mtd_info
), GFP_KERNEL
);
146 (*curmtd
)->next
= NULL
;
148 if ((*curmtd
)->mtdinfo
) {
149 (*curmtd
)->mtdinfo
->priv
=
150 kzalloc(sizeof(slram_priv_t
), GFP_KERNEL
);
152 if (!(*curmtd
)->mtdinfo
->priv
) {
153 kfree((*curmtd
)->mtdinfo
);
154 (*curmtd
)->mtdinfo
= NULL
;
158 if (!(*curmtd
)->mtdinfo
) {
159 E("slram: Cannot allocate new MTD device.\n");
163 if (!(((slram_priv_t
*)(*curmtd
)->mtdinfo
->priv
)->start
=
164 ioremap(start
, length
))) {
165 E("slram: ioremap failed\n");
168 ((slram_priv_t
*)(*curmtd
)->mtdinfo
->priv
)->end
=
169 ((slram_priv_t
*)(*curmtd
)->mtdinfo
->priv
)->start
+ length
;
172 (*curmtd
)->mtdinfo
->name
= name
;
173 (*curmtd
)->mtdinfo
->size
= length
;
174 (*curmtd
)->mtdinfo
->flags
= MTD_CAP_RAM
;
175 (*curmtd
)->mtdinfo
->erase
= slram_erase
;
176 (*curmtd
)->mtdinfo
->point
= slram_point
;
177 (*curmtd
)->mtdinfo
->unpoint
= slram_unpoint
;
178 (*curmtd
)->mtdinfo
->read
= slram_read
;
179 (*curmtd
)->mtdinfo
->write
= slram_write
;
180 (*curmtd
)->mtdinfo
->owner
= THIS_MODULE
;
181 (*curmtd
)->mtdinfo
->type
= MTD_RAM
;
182 (*curmtd
)->mtdinfo
->erasesize
= SLRAM_BLK_SZ
;
183 (*curmtd
)->mtdinfo
->writesize
= 1;
185 if (add_mtd_device((*curmtd
)->mtdinfo
)) {
186 E("slram: Failed to register new device\n");
187 iounmap(((slram_priv_t
*)(*curmtd
)->mtdinfo
->priv
)->start
);
188 kfree((*curmtd
)->mtdinfo
->priv
);
189 kfree((*curmtd
)->mtdinfo
);
192 T("slram: Registered device %s from %luKiB to %luKiB\n", name
,
193 (start
/ 1024), ((start
+ length
) / 1024));
194 T("slram: Mapped from 0x%p to 0x%p\n",
195 ((slram_priv_t
*)(*curmtd
)->mtdinfo
->priv
)->start
,
196 ((slram_priv_t
*)(*curmtd
)->mtdinfo
->priv
)->end
);
200 static void unregister_devices(void)
202 slram_mtd_list_t
*nextitem
;
204 while (slram_mtdlist
) {
205 nextitem
= slram_mtdlist
->next
;
206 del_mtd_device(slram_mtdlist
->mtdinfo
);
207 iounmap(((slram_priv_t
*)slram_mtdlist
->mtdinfo
->priv
)->start
);
208 kfree(slram_mtdlist
->mtdinfo
->priv
);
209 kfree(slram_mtdlist
->mtdinfo
);
210 kfree(slram_mtdlist
);
211 slram_mtdlist
= nextitem
;
215 static unsigned long handle_unit(unsigned long value
, char *unit
)
217 if ((*unit
== 'M') || (*unit
== 'm')) {
218 return(value
* 1024 * 1024);
219 } else if ((*unit
== 'K') || (*unit
== 'k')) {
220 return(value
* 1024);
225 static int parse_cmdline(char *devname
, char *szstart
, char *szlength
)
228 unsigned long devstart
;
229 unsigned long devlength
;
231 if ((!devname
) || (!szstart
) || (!szlength
)) {
232 unregister_devices();
236 devstart
= simple_strtoul(szstart
, &buffer
, 0);
237 devstart
= handle_unit(devstart
, buffer
);
239 if (*(szlength
) != '+') {
240 devlength
= simple_strtoul(szlength
, &buffer
, 0);
241 devlength
= handle_unit(devlength
, buffer
) - devstart
;
242 if (devlength
< devstart
)
245 devlength
-= devstart
;
247 devlength
= simple_strtoul(szlength
+ 1, &buffer
, 0);
248 devlength
= handle_unit(devlength
, buffer
);
250 T("slram: devname=%s, devstart=0x%lx, devlength=0x%lx\n",
251 devname
, devstart
, devlength
);
252 if (devlength
% SLRAM_BLK_SZ
!= 0)
255 if ((devstart
= register_device(devname
, devstart
, devlength
))){
256 unregister_devices();
257 return((int)devstart
);
262 E("slram: Illegal length parameter.\n");
268 static int __init
mtd_slram_setup(char *str
)
274 __setup("slram=", mtd_slram_setup
);
278 static int __init
init_slram(void)
290 E("slram: not enough parameters.\n");
294 devname
= devstart
= devlength
= NULL
;
296 if (!(devname
= strsep(&map
, ","))) {
297 E("slram: No devicename specified.\n");
300 T("slram: devname = %s\n", devname
);
301 if ((!map
) || (!(devstart
= strsep(&map
, ",")))) {
302 E("slram: No devicestart specified.\n");
304 T("slram: devstart = %s\n", devstart
);
305 if ((!map
) || (!(devlength
= strsep(&map
, ",")))) {
306 E("slram: No devicelength / -end specified.\n");
308 T("slram: devlength = %s\n", devlength
);
309 if (parse_cmdline(devname
, devstart
, devlength
) != 0) {
316 for (count
= 0; count
< SLRAM_MAX_DEVICES_PARAMS
&& map
[count
];
320 if ((count
% 3 != 0) || (count
== 0)) {
321 E("slram: not enough parameters.\n");
324 for (i
= 0; i
< (count
/ 3); i
++) {
325 devname
= map
[i
* 3];
327 if (parse_cmdline(devname
, map
[i
* 3 + 1], map
[i
* 3 + 2])!=0) {
337 static void __exit
cleanup_slram(void)
339 unregister_devices();
342 module_init(init_slram
);
343 module_exit(cleanup_slram
);
345 MODULE_LICENSE("GPL");
346 MODULE_AUTHOR("Jochen Schaeuble <psionic@psionic.de>");
347 MODULE_DESCRIPTION("MTD driver for uncached system RAM");