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 | ||
e79265ba JW |
23 | static bool node_has_compatible(struct device_node *pp) |
24 | { | |
25 | return of_get_property(pp, "compatible", NULL); | |
26 | } | |
27 | ||
d26c87d6 DES |
28 | static int parse_ofpart_partitions(struct mtd_info *master, |
29 | struct mtd_partition **pparts, | |
30 | struct mtd_part_parser_data *data) | |
31 | { | |
5cfdedb7 MS |
32 | struct device_node *mtd_node; |
33 | struct device_node *ofpart_node; | |
9a310d21 SW |
34 | const char *partname; |
35 | struct device_node *pp; | |
5cfdedb7 MS |
36 | int nr_parts, i, ret = 0; |
37 | bool dedicated = true; | |
9a310d21 | 38 | |
628376fb DES |
39 | |
40 | if (!data) | |
41 | return 0; | |
42 | ||
5cfdedb7 MS |
43 | mtd_node = data->of_node; |
44 | if (!mtd_node) | |
628376fb DES |
45 | return 0; |
46 | ||
5cfdedb7 MS |
47 | ofpart_node = of_get_child_by_name(mtd_node, "partitions"); |
48 | if (!ofpart_node) { | |
49 | pr_warn("%s: 'partitions' subnode not found on %s. Trying to parse direct subnodes as partitions.\n", | |
50 | master->name, mtd_node->full_name); | |
51 | ofpart_node = mtd_node; | |
52 | dedicated = false; | |
53 | } | |
54 | ||
9a310d21 | 55 | /* First count the subnodes */ |
9a310d21 | 56 | nr_parts = 0; |
5cfdedb7 MS |
57 | for_each_child_of_node(ofpart_node, pp) { |
58 | if (!dedicated && node_has_compatible(pp)) | |
e79265ba JW |
59 | continue; |
60 | ||
9a310d21 | 61 | nr_parts++; |
e79265ba | 62 | } |
9a310d21 SW |
63 | |
64 | if (nr_parts == 0) | |
65 | return 0; | |
66 | ||
67 | *pparts = kzalloc(nr_parts * sizeof(**pparts), GFP_KERNEL); | |
68 | if (!*pparts) | |
69 | return -ENOMEM; | |
70 | ||
9a310d21 | 71 | i = 0; |
5cfdedb7 | 72 | for_each_child_of_node(ofpart_node, pp) { |
766f271a | 73 | const __be32 *reg; |
9a310d21 | 74 | int len; |
05ff8c25 | 75 | int a_cells, s_cells; |
9a310d21 | 76 | |
5cfdedb7 | 77 | if (!dedicated && node_has_compatible(pp)) |
e79265ba JW |
78 | continue; |
79 | ||
ebd5a74d BK |
80 | reg = of_get_property(pp, "reg", &len); |
81 | if (!reg) { | |
5cfdedb7 MS |
82 | if (dedicated) { |
83 | pr_debug("%s: ofpart partition %s (%s) missing reg property.\n", | |
84 | master->name, pp->full_name, | |
85 | mtd_node->full_name); | |
86 | goto ofpart_fail; | |
87 | } else { | |
88 | nr_parts--; | |
89 | continue; | |
90 | } | |
4b08e149 BK |
91 | } |
92 | ||
05ff8c25 JS |
93 | a_cells = of_n_addr_cells(pp); |
94 | s_cells = of_n_size_cells(pp); | |
5cfdedb7 MS |
95 | if (len / 4 != a_cells + s_cells) { |
96 | pr_debug("%s: ofpart partition %s (%s) error parsing reg property.\n", | |
97 | master->name, pp->full_name, | |
98 | mtd_node->full_name); | |
99 | goto ofpart_fail; | |
100 | } | |
101 | ||
05ff8c25 JS |
102 | (*pparts)[i].offset = of_read_number(reg, a_cells); |
103 | (*pparts)[i].size = of_read_number(reg + a_cells, s_cells); | |
9a310d21 SW |
104 | |
105 | partname = of_get_property(pp, "label", &len); | |
106 | if (!partname) | |
107 | partname = of_get_property(pp, "name", &len); | |
26a6d240 | 108 | (*pparts)[i].name = partname; |
9a310d21 SW |
109 | |
110 | if (of_get_property(pp, "read-only", &len)) | |
ab0b00bc JR |
111 | (*pparts)[i].mask_flags |= MTD_WRITEABLE; |
112 | ||
113 | if (of_get_property(pp, "lock", &len)) | |
114 | (*pparts)[i].mask_flags |= MTD_POWERUP_LOCK; | |
9a310d21 SW |
115 | |
116 | i++; | |
117 | } | |
118 | ||
5cfdedb7 MS |
119 | if (!nr_parts) |
120 | goto ofpart_none; | |
ebd5a74d | 121 | |
9a310d21 | 122 | return nr_parts; |
5cfdedb7 MS |
123 | |
124 | ofpart_fail: | |
125 | pr_err("%s: error parsing ofpart partition %s (%s)\n", | |
126 | master->name, pp->full_name, mtd_node->full_name); | |
127 | ret = -EINVAL; | |
128 | ofpart_none: | |
129 | of_node_put(pp); | |
130 | kfree(*pparts); | |
131 | *pparts = NULL; | |
132 | return ret; | |
9a310d21 | 133 | } |
950bcb25 | 134 | |
d26c87d6 DES |
135 | static struct mtd_part_parser ofpart_parser = { |
136 | .owner = THIS_MODULE, | |
137 | .parse_fn = parse_ofpart_partitions, | |
138 | .name = "ofpart", | |
139 | }; | |
140 | ||
fbcf62a3 DES |
141 | static int parse_ofoldpart_partitions(struct mtd_info *master, |
142 | struct mtd_partition **pparts, | |
143 | struct mtd_part_parser_data *data) | |
144 | { | |
145 | struct device_node *dp; | |
146 | int i, plen, nr_parts; | |
147 | const struct { | |
148 | __be32 offset, len; | |
149 | } *part; | |
150 | const char *names; | |
151 | ||
152 | if (!data) | |
153 | return 0; | |
154 | ||
155 | dp = data->of_node; | |
156 | if (!dp) | |
157 | return 0; | |
158 | ||
159 | part = of_get_property(dp, "partitions", &plen); | |
160 | if (!part) | |
161 | return 0; /* No partitions found */ | |
162 | ||
163 | pr_warning("Device tree uses obsolete partition map binding: %s\n", | |
164 | dp->full_name); | |
165 | ||
166 | nr_parts = plen / sizeof(part[0]); | |
167 | ||
168 | *pparts = kzalloc(nr_parts * sizeof(*(*pparts)), GFP_KERNEL); | |
ecbcbc7b | 169 | if (!*pparts) |
fbcf62a3 DES |
170 | return -ENOMEM; |
171 | ||
172 | names = of_get_property(dp, "partition-names", &plen); | |
173 | ||
174 | for (i = 0; i < nr_parts; i++) { | |
175 | (*pparts)[i].offset = be32_to_cpu(part->offset); | |
176 | (*pparts)[i].size = be32_to_cpu(part->len) & ~1; | |
177 | /* bit 0 set signifies read only partition */ | |
178 | if (be32_to_cpu(part->len) & 1) | |
179 | (*pparts)[i].mask_flags = MTD_WRITEABLE; | |
180 | ||
181 | if (names && (plen > 0)) { | |
182 | int len = strlen(names) + 1; | |
183 | ||
26a6d240 | 184 | (*pparts)[i].name = names; |
fbcf62a3 DES |
185 | plen -= len; |
186 | names += len; | |
187 | } else { | |
188 | (*pparts)[i].name = "unnamed"; | |
189 | } | |
190 | ||
191 | part++; | |
192 | } | |
193 | ||
194 | return nr_parts; | |
195 | } | |
196 | ||
197 | static struct mtd_part_parser ofoldpart_parser = { | |
198 | .owner = THIS_MODULE, | |
199 | .parse_fn = parse_ofoldpart_partitions, | |
200 | .name = "ofoldpart", | |
201 | }; | |
202 | ||
d26c87d6 DES |
203 | static int __init ofpart_parser_init(void) |
204 | { | |
6e14a61d AL |
205 | register_mtd_parser(&ofpart_parser); |
206 | register_mtd_parser(&ofoldpart_parser); | |
207 | return 0; | |
d26c87d6 DES |
208 | } |
209 | ||
422f3890 LR |
210 | static void __exit ofpart_parser_exit(void) |
211 | { | |
212 | deregister_mtd_parser(&ofpart_parser); | |
213 | deregister_mtd_parser(&ofoldpart_parser); | |
214 | } | |
215 | ||
d26c87d6 | 216 | module_init(ofpart_parser_init); |
422f3890 | 217 | module_exit(ofpart_parser_exit); |
d26c87d6 | 218 | |
950bcb25 | 219 | MODULE_LICENSE("GPL"); |
d6137bad DES |
220 | MODULE_DESCRIPTION("Parser for MTD partitioning information in device tree"); |
221 | MODULE_AUTHOR("Vitaly Wool, David Gibson"); | |
9786f6e6 DES |
222 | /* |
223 | * When MTD core cannot find the requested parser, it tries to load the module | |
224 | * with the same name. Since we provide the ofoldpart parser, we should have | |
225 | * the corresponding alias. | |
226 | */ | |
227 | MODULE_ALIAS("ofoldpart"); |