Commit | Line | Data |
---|---|---|
9a310d21 SW |
1 | /* |
2 | * Flash partitions described by the OF (or flattened) device tree | |
3 | * | |
a1452a37 | 4 | * Copyright © 2006 MontaVista Software Inc. |
9a310d21 SW |
5 | * Author: Vitaly Wool <vwool@ru.mvista.com> |
6 | * | |
7 | * Revised to handle newer style flash binding by: | |
a1452a37 | 8 | * Copyright © 2007 David Gibson, IBM Corporation. |
9a310d21 SW |
9 | * |
10 | * This program is free software; you can redistribute it and/or modify it | |
11 | * under the terms of the GNU General Public License as published by the | |
12 | * Free Software Foundation; either version 2 of the License, or (at your | |
13 | * option) any later version. | |
14 | */ | |
15 | ||
16 | #include <linux/module.h> | |
17 | #include <linux/init.h> | |
18 | #include <linux/of.h> | |
19 | #include <linux/mtd/mtd.h> | |
5a0e3ad6 | 20 | #include <linux/slab.h> |
9a310d21 SW |
21 | #include <linux/mtd/partitions.h> |
22 | ||
d26c87d6 DES |
23 | static int parse_ofpart_partitions(struct mtd_info *master, |
24 | struct mtd_partition **pparts, | |
25 | struct mtd_part_parser_data *data) | |
26 | { | |
628376fb | 27 | struct device_node *node; |
9a310d21 SW |
28 | const char *partname; |
29 | struct device_node *pp; | |
30 | int nr_parts, i; | |
31 | ||
628376fb DES |
32 | |
33 | if (!data) | |
34 | return 0; | |
35 | ||
36 | node = data->of_node; | |
37 | if (!node) | |
38 | return 0; | |
39 | ||
9a310d21 SW |
40 | /* First count the subnodes */ |
41 | pp = NULL; | |
42 | nr_parts = 0; | |
43 | while ((pp = of_get_next_child(node, pp))) | |
44 | nr_parts++; | |
45 | ||
46 | if (nr_parts == 0) | |
47 | return 0; | |
48 | ||
49 | *pparts = kzalloc(nr_parts * sizeof(**pparts), GFP_KERNEL); | |
50 | if (!*pparts) | |
51 | return -ENOMEM; | |
52 | ||
53 | pp = NULL; | |
54 | i = 0; | |
55 | while ((pp = of_get_next_child(node, pp))) { | |
766f271a | 56 | const __be32 *reg; |
9a310d21 | 57 | int len; |
05ff8c25 | 58 | int a_cells, s_cells; |
9a310d21 | 59 | |
ebd5a74d BK |
60 | reg = of_get_property(pp, "reg", &len); |
61 | if (!reg) { | |
4b08e149 BK |
62 | nr_parts--; |
63 | continue; | |
64 | } | |
65 | ||
05ff8c25 JS |
66 | a_cells = of_n_addr_cells(pp); |
67 | s_cells = of_n_size_cells(pp); | |
68 | (*pparts)[i].offset = of_read_number(reg, a_cells); | |
69 | (*pparts)[i].size = of_read_number(reg + a_cells, s_cells); | |
9a310d21 SW |
70 | |
71 | partname = of_get_property(pp, "label", &len); | |
72 | if (!partname) | |
73 | partname = of_get_property(pp, "name", &len); | |
74 | (*pparts)[i].name = (char *)partname; | |
75 | ||
76 | if (of_get_property(pp, "read-only", &len)) | |
ab0b00bc JR |
77 | (*pparts)[i].mask_flags |= MTD_WRITEABLE; |
78 | ||
79 | if (of_get_property(pp, "lock", &len)) | |
80 | (*pparts)[i].mask_flags |= MTD_POWERUP_LOCK; | |
9a310d21 SW |
81 | |
82 | i++; | |
83 | } | |
84 | ||
ebd5a74d BK |
85 | if (!i) { |
86 | of_node_put(pp); | |
d26c87d6 | 87 | pr_err("No valid partition found on %s\n", node->full_name); |
ebd5a74d BK |
88 | kfree(*pparts); |
89 | *pparts = NULL; | |
90 | return -EINVAL; | |
91 | } | |
92 | ||
9a310d21 SW |
93 | return nr_parts; |
94 | } | |
950bcb25 | 95 | |
d26c87d6 DES |
96 | static struct mtd_part_parser ofpart_parser = { |
97 | .owner = THIS_MODULE, | |
98 | .parse_fn = parse_ofpart_partitions, | |
99 | .name = "ofpart", | |
100 | }; | |
101 | ||
fbcf62a3 DES |
102 | static int parse_ofoldpart_partitions(struct mtd_info *master, |
103 | struct mtd_partition **pparts, | |
104 | struct mtd_part_parser_data *data) | |
105 | { | |
106 | struct device_node *dp; | |
107 | int i, plen, nr_parts; | |
108 | const struct { | |
109 | __be32 offset, len; | |
110 | } *part; | |
111 | const char *names; | |
112 | ||
113 | if (!data) | |
114 | return 0; | |
115 | ||
116 | dp = data->of_node; | |
117 | if (!dp) | |
118 | return 0; | |
119 | ||
120 | part = of_get_property(dp, "partitions", &plen); | |
121 | if (!part) | |
122 | return 0; /* No partitions found */ | |
123 | ||
124 | pr_warning("Device tree uses obsolete partition map binding: %s\n", | |
125 | dp->full_name); | |
126 | ||
127 | nr_parts = plen / sizeof(part[0]); | |
128 | ||
129 | *pparts = kzalloc(nr_parts * sizeof(*(*pparts)), GFP_KERNEL); | |
ecbcbc7b | 130 | if (!*pparts) |
fbcf62a3 DES |
131 | return -ENOMEM; |
132 | ||
133 | names = of_get_property(dp, "partition-names", &plen); | |
134 | ||
135 | for (i = 0; i < nr_parts; i++) { | |
136 | (*pparts)[i].offset = be32_to_cpu(part->offset); | |
137 | (*pparts)[i].size = be32_to_cpu(part->len) & ~1; | |
138 | /* bit 0 set signifies read only partition */ | |
139 | if (be32_to_cpu(part->len) & 1) | |
140 | (*pparts)[i].mask_flags = MTD_WRITEABLE; | |
141 | ||
142 | if (names && (plen > 0)) { | |
143 | int len = strlen(names) + 1; | |
144 | ||
145 | (*pparts)[i].name = (char *)names; | |
146 | plen -= len; | |
147 | names += len; | |
148 | } else { | |
149 | (*pparts)[i].name = "unnamed"; | |
150 | } | |
151 | ||
152 | part++; | |
153 | } | |
154 | ||
155 | return nr_parts; | |
156 | } | |
157 | ||
158 | static struct mtd_part_parser ofoldpart_parser = { | |
159 | .owner = THIS_MODULE, | |
160 | .parse_fn = parse_ofoldpart_partitions, | |
161 | .name = "ofoldpart", | |
162 | }; | |
163 | ||
d26c87d6 DES |
164 | static int __init ofpart_parser_init(void) |
165 | { | |
fbcf62a3 DES |
166 | int rc; |
167 | rc = register_mtd_parser(&ofpart_parser); | |
168 | if (rc) | |
169 | goto out; | |
170 | ||
171 | rc = register_mtd_parser(&ofoldpart_parser); | |
172 | if (!rc) | |
173 | return 0; | |
174 | ||
175 | deregister_mtd_parser(&ofoldpart_parser); | |
176 | out: | |
177 | return rc; | |
d26c87d6 DES |
178 | } |
179 | ||
422f3890 LR |
180 | static void __exit ofpart_parser_exit(void) |
181 | { | |
182 | deregister_mtd_parser(&ofpart_parser); | |
183 | deregister_mtd_parser(&ofoldpart_parser); | |
184 | } | |
185 | ||
d26c87d6 | 186 | module_init(ofpart_parser_init); |
422f3890 | 187 | module_exit(ofpart_parser_exit); |
d26c87d6 | 188 | |
950bcb25 | 189 | MODULE_LICENSE("GPL"); |
d6137bad DES |
190 | MODULE_DESCRIPTION("Parser for MTD partitioning information in device tree"); |
191 | MODULE_AUTHOR("Vitaly Wool, David Gibson"); | |
9786f6e6 DES |
192 | /* |
193 | * When MTD core cannot find the requested parser, it tries to load the module | |
194 | * with the same name. Since we provide the ofoldpart parser, we should have | |
195 | * the corresponding alias. | |
196 | */ | |
197 | MODULE_ALIAS("ofoldpart"); |