1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38#define pr_fmt(fmt) "mtd: " fmt
39
40#include <linux/kernel.h>
41#include <linux/slab.h>
42#include <linux/mtd/mtd.h>
43#include <linux/mtd/partitions.h>
44#include <linux/module.h>
45#include <linux/err.h>
46
47
48#if 0
49#define dbg(x) do { printk("DEBUG-CMDLINE-PART: "); printk x; } while(0)
50#else
51#define dbg(x)
52#endif
53
54
55
56#define SIZE_REMAINING ULLONG_MAX
57#define OFFSET_CONTINUOUS ULLONG_MAX
58
59struct cmdline_mtd_partition {
60 struct cmdline_mtd_partition *next;
61 char *mtd_id;
62 int num_parts;
63 struct mtd_partition *parts;
64};
65
66
67static struct cmdline_mtd_partition *partitions;
68
69
70static char *mtdparts;
71static char *cmdline;
72static int cmdline_parsed;
73
74
75
76
77
78
79
80
81
82static struct mtd_partition * newpart(char *s,
83 char **retptr,
84 int *num_parts,
85 int this_part,
86 unsigned char **extra_mem_ptr,
87 int extra_mem_size)
88{
89 struct mtd_partition *parts;
90 unsigned long long size, offset = OFFSET_CONTINUOUS;
91 char *name;
92 int name_len;
93 unsigned char *extra_mem;
94 char delim;
95 unsigned int mask_flags, add_flags;
96
97
98 if (*s == '-') {
99
100 size = SIZE_REMAINING;
101 s++;
102 } else {
103 size = memparse(s, &s);
104 if (!size) {
105 pr_err("partition has size 0\n");
106 return ERR_PTR(-EINVAL);
107 }
108 }
109
110
111 mask_flags = 0;
112 add_flags = 0;
113 delim = 0;
114
115
116 if (*s == '@') {
117 s++;
118 offset = memparse(s, &s);
119 }
120
121
122 if (*s == '(')
123 delim = ')';
124
125 if (delim) {
126 char *p;
127
128 name = ++s;
129 p = strchr(name, delim);
130 if (!p) {
131 pr_err("no closing %c found in partition name\n", delim);
132 return ERR_PTR(-EINVAL);
133 }
134 name_len = p - name;
135 s = p + 1;
136 } else {
137 name = NULL;
138 name_len = 13;
139 }
140
141
142 extra_mem_size += name_len + 1;
143
144
145 if (strncmp(s, "ro", 2) == 0) {
146 mask_flags |= MTD_WRITEABLE;
147 s += 2;
148 }
149
150
151 if (strncmp(s, "lk", 2) == 0) {
152 mask_flags |= MTD_POWERUP_LOCK;
153 s += 2;
154 }
155
156
157 if (!strncmp(s, "slc", 3)) {
158 add_flags |= MTD_SLC_ON_MLC_EMULATION;
159 s += 3;
160 }
161
162
163 if (*s == ',') {
164 if (size == SIZE_REMAINING) {
165 pr_err("no partitions allowed after a fill-up partition\n");
166 return ERR_PTR(-EINVAL);
167 }
168
169 parts = newpart(s + 1, &s, num_parts, this_part + 1,
170 &extra_mem, extra_mem_size);
171 if (IS_ERR(parts))
172 return parts;
173 } else {
174
175 int alloc_size;
176
177 *num_parts = this_part + 1;
178 alloc_size = *num_parts * sizeof(struct mtd_partition) +
179 extra_mem_size;
180
181 parts = kzalloc(alloc_size, GFP_KERNEL);
182 if (!parts)
183 return ERR_PTR(-ENOMEM);
184 extra_mem = (unsigned char *)(parts + *num_parts);
185 }
186
187
188
189
190
191 parts[this_part].size = size;
192 parts[this_part].offset = offset;
193 parts[this_part].mask_flags = mask_flags;
194 parts[this_part].add_flags = add_flags;
195 if (name)
196 strlcpy(extra_mem, name, name_len + 1);
197 else
198 sprintf(extra_mem, "Partition_%03d", this_part);
199 parts[this_part].name = extra_mem;
200 extra_mem += name_len + 1;
201
202 dbg(("partition %d: name <%s>, offset %llx, size %llx, mask flags %x\n",
203 this_part, parts[this_part].name, parts[this_part].offset,
204 parts[this_part].size, parts[this_part].mask_flags));
205
206
207 if (extra_mem_ptr)
208 *extra_mem_ptr = extra_mem;
209
210
211 *retptr = s;
212
213
214 return parts;
215}
216
217
218
219
220static int mtdpart_setup_real(char *s)
221{
222 cmdline_parsed = 1;
223
224 for( ; s != NULL; )
225 {
226 struct cmdline_mtd_partition *this_mtd;
227 struct mtd_partition *parts;
228 int mtd_id_len, num_parts;
229 char *p, *mtd_id, *semicol;
230
231
232
233
234
235 semicol = strchr(s, ';');
236 if (semicol)
237 *semicol = '\0';
238
239 mtd_id = s;
240
241
242
243
244
245
246 p = strrchr(s, ':');
247
248
249 if (semicol)
250 *semicol = ';';
251
252 if (!p) {
253 pr_err("no mtd-id\n");
254 return -EINVAL;
255 }
256 mtd_id_len = p - mtd_id;
257
258 dbg(("parsing <%s>\n", p+1));
259
260
261
262
263
264 parts = newpart(p + 1,
265 &s,
266 &num_parts,
267 0,
268 (unsigned char**)&this_mtd,
269 mtd_id_len + 1 + sizeof(*this_mtd) +
270 sizeof(void*)-1 );
271 if (IS_ERR(parts)) {
272
273
274
275
276
277
278
279 return PTR_ERR(parts);
280 }
281
282
283 this_mtd = (struct cmdline_mtd_partition *)
284 ALIGN((unsigned long)this_mtd, sizeof(void *));
285
286 this_mtd->parts = parts;
287 this_mtd->num_parts = num_parts;
288 this_mtd->mtd_id = (char*)(this_mtd + 1);
289 strlcpy(this_mtd->mtd_id, mtd_id, mtd_id_len + 1);
290
291
292 this_mtd->next = partitions;
293 partitions = this_mtd;
294
295 dbg(("mtdid=<%s> num_parts=<%d>\n",
296 this_mtd->mtd_id, this_mtd->num_parts));
297
298
299
300 if (*s == 0)
301 break;
302
303
304 if (*s != ';') {
305 pr_err("bad character after partition (%c)\n", *s);
306 return -EINVAL;
307 }
308 s++;
309 }
310
311 return 0;
312}
313
314
315
316
317
318
319
320
321static int parse_cmdline_partitions(struct mtd_info *master,
322 const struct mtd_partition **pparts,
323 struct mtd_part_parser_data *data)
324{
325 unsigned long long offset;
326 int i, err;
327 struct cmdline_mtd_partition *part;
328 const char *mtd_id = master->name;
329
330
331 if (!cmdline_parsed) {
332 err = mtdpart_setup_real(cmdline);
333 if (err)
334 return err;
335 }
336
337
338
339
340
341 for (part = partitions; part; part = part->next) {
342 if ((!mtd_id) || (!strcmp(part->mtd_id, mtd_id)))
343 break;
344 }
345
346 if (!part)
347 return 0;
348
349 for (i = 0, offset = 0; i < part->num_parts; i++) {
350 if (part->parts[i].offset == OFFSET_CONTINUOUS)
351 part->parts[i].offset = offset;
352 else
353 offset = part->parts[i].offset;
354
355 if (part->parts[i].size == SIZE_REMAINING)
356 part->parts[i].size = master->size - offset;
357
358 if (offset + part->parts[i].size > master->size) {
359 pr_warn("%s: partitioning exceeds flash size, truncating\n",
360 part->mtd_id);
361 part->parts[i].size = master->size - offset;
362 }
363 offset += part->parts[i].size;
364
365 if (part->parts[i].size == 0) {
366 pr_warn("%s: skipping zero sized partition\n",
367 part->mtd_id);
368 part->num_parts--;
369 memmove(&part->parts[i], &part->parts[i + 1],
370 sizeof(*part->parts) * (part->num_parts - i));
371 i--;
372 }
373 }
374
375 *pparts = kmemdup(part->parts, sizeof(*part->parts) * part->num_parts,
376 GFP_KERNEL);
377 if (!*pparts)
378 return -ENOMEM;
379
380 return part->num_parts;
381}
382
383
384
385
386
387
388
389
390
391static int __init mtdpart_setup(char *s)
392{
393 cmdline = s;
394 return 1;
395}
396
397__setup("mtdparts=", mtdpart_setup);
398
399static struct mtd_part_parser cmdline_parser = {
400 .parse_fn = parse_cmdline_partitions,
401 .name = "cmdlinepart",
402};
403
404static int __init cmdline_parser_init(void)
405{
406 if (mtdparts)
407 mtdpart_setup(mtdparts);
408 register_mtd_parser(&cmdline_parser);
409 return 0;
410}
411
412static void __exit cmdline_parser_exit(void)
413{
414 deregister_mtd_parser(&cmdline_parser);
415}
416
417module_init(cmdline_parser_init);
418module_exit(cmdline_parser_exit);
419
420MODULE_PARM_DESC(mtdparts, "Partitioning specification");
421module_param(mtdparts, charp, 0);
422
423MODULE_LICENSE("GPL");
424MODULE_AUTHOR("Marius Groeger <mag@sysgo.de>");
425MODULE_DESCRIPTION("Command line configuration of MTD partitions");
426