This source file includes following definitions.
- powernv_flash_async_op
- powernv_flash_read
- powernv_flash_write
- powernv_flash_erase
- powernv_flash_set_driver_info
- powernv_flash_probe
- powernv_flash_release
1
2
3
4
5
6
7
8 #include <linux/kernel.h>
9 #include <linux/module.h>
10 #include <linux/errno.h>
11 #include <linux/of.h>
12 #include <linux/of_address.h>
13 #include <linux/platform_device.h>
14 #include <linux/string.h>
15 #include <linux/slab.h>
16 #include <linux/mtd/mtd.h>
17 #include <linux/mtd/partitions.h>
18
19 #include <linux/debugfs.h>
20 #include <linux/seq_file.h>
21
22 #include <asm/opal.h>
23
24
25
26
27
28
29
30 struct powernv_flash {
31 struct mtd_info mtd;
32 u32 id;
33 };
34
35 enum flash_op {
36 FLASH_OP_READ,
37 FLASH_OP_WRITE,
38 FLASH_OP_ERASE,
39 };
40
41
42
43
44
45
46 static int powernv_flash_async_op(struct mtd_info *mtd, enum flash_op op,
47 loff_t offset, size_t len, size_t *retlen, u_char *buf)
48 {
49 struct powernv_flash *info = (struct powernv_flash *)mtd->priv;
50 struct device *dev = &mtd->dev;
51 int token;
52 struct opal_msg msg;
53 int rc;
54
55 dev_dbg(dev, "%s(op=%d, offset=0x%llx, len=%zu)\n",
56 __func__, op, offset, len);
57
58 token = opal_async_get_token_interruptible();
59 if (token < 0) {
60 if (token != -ERESTARTSYS)
61 dev_err(dev, "Failed to get an async token\n");
62 else
63 token = -EINTR;
64 return token;
65 }
66
67 switch (op) {
68 case FLASH_OP_READ:
69 rc = opal_flash_read(info->id, offset, __pa(buf), len, token);
70 break;
71 case FLASH_OP_WRITE:
72 rc = opal_flash_write(info->id, offset, __pa(buf), len, token);
73 break;
74 case FLASH_OP_ERASE:
75 rc = opal_flash_erase(info->id, offset, len, token);
76 break;
77 default:
78 WARN_ON_ONCE(1);
79 opal_async_release_token(token);
80 return -EIO;
81 }
82
83 if (rc == OPAL_ASYNC_COMPLETION) {
84 rc = opal_async_wait_response_interruptible(token, &msg);
85 if (rc) {
86
87
88
89
90
91
92
93
94
95
96
97
98 rc = -EINTR;
99 if (opal_async_wait_response(token, &msg))
100 dev_err(dev, "opal_async_wait_response() failed\n");
101 goto out;
102 }
103 rc = opal_get_async_rc(msg);
104 }
105
106
107
108
109
110
111
112
113
114
115 if (rc != OPAL_SUCCESS && rc != OPAL_BUSY)
116 dev_err(dev, "opal_flash_async_op(op=%d) failed (rc %d)\n",
117 op, rc);
118
119 if (rc == OPAL_SUCCESS && retlen)
120 *retlen = len;
121
122 rc = opal_error_code(rc);
123 out:
124 opal_async_release_token(token);
125 return rc;
126 }
127
128
129
130
131
132
133
134
135
136
137 static int powernv_flash_read(struct mtd_info *mtd, loff_t from, size_t len,
138 size_t *retlen, u_char *buf)
139 {
140 return powernv_flash_async_op(mtd, FLASH_OP_READ, from,
141 len, retlen, buf);
142 }
143
144
145
146
147
148
149
150
151
152
153 static int powernv_flash_write(struct mtd_info *mtd, loff_t to, size_t len,
154 size_t *retlen, const u_char *buf)
155 {
156 return powernv_flash_async_op(mtd, FLASH_OP_WRITE, to,
157 len, retlen, (u_char *)buf);
158 }
159
160
161
162
163
164
165 static int powernv_flash_erase(struct mtd_info *mtd, struct erase_info *erase)
166 {
167 int rc;
168
169 rc = powernv_flash_async_op(mtd, FLASH_OP_ERASE, erase->addr,
170 erase->len, NULL, NULL);
171 if (rc)
172 erase->fail_addr = erase->addr;
173
174 return rc;
175 }
176
177
178
179
180
181
182 static int powernv_flash_set_driver_info(struct device *dev,
183 struct mtd_info *mtd)
184 {
185 u64 size;
186 u32 erase_size;
187 int rc;
188
189 rc = of_property_read_u32(dev->of_node, "ibm,flash-block-size",
190 &erase_size);
191 if (rc) {
192 dev_err(dev, "couldn't get resource block size information\n");
193 return rc;
194 }
195
196 rc = of_property_read_u64(dev->of_node, "reg", &size);
197 if (rc) {
198 dev_err(dev, "couldn't get resource size information\n");
199 return rc;
200 }
201
202
203
204
205
206 mtd->name = devm_kasprintf(dev, GFP_KERNEL, "%pOFP", dev->of_node);
207 mtd->type = MTD_NORFLASH;
208 mtd->flags = MTD_WRITEABLE;
209 mtd->size = size;
210 mtd->erasesize = erase_size;
211 mtd->writebufsize = mtd->writesize = 1;
212 mtd->owner = THIS_MODULE;
213 mtd->_erase = powernv_flash_erase;
214 mtd->_read = powernv_flash_read;
215 mtd->_write = powernv_flash_write;
216 mtd->dev.parent = dev;
217 mtd_set_of_node(mtd, dev->of_node);
218 return 0;
219 }
220
221
222
223
224
225
226
227 static int powernv_flash_probe(struct platform_device *pdev)
228 {
229 struct device *dev = &pdev->dev;
230 struct powernv_flash *data;
231 int ret;
232
233 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
234 if (!data)
235 return -ENOMEM;
236
237 data->mtd.priv = data;
238
239 ret = of_property_read_u32(dev->of_node, "ibm,opal-id", &(data->id));
240 if (ret) {
241 dev_err(dev, "no device property 'ibm,opal-id'\n");
242 return ret;
243 }
244
245 ret = powernv_flash_set_driver_info(dev, &data->mtd);
246 if (ret)
247 return ret;
248
249 dev_set_drvdata(dev, data);
250
251
252
253
254
255
256 return mtd_device_register(&data->mtd, NULL, 0);
257 }
258
259
260
261
262
263
264
265 static int powernv_flash_release(struct platform_device *pdev)
266 {
267 struct powernv_flash *data = dev_get_drvdata(&(pdev->dev));
268
269
270 return mtd_device_unregister(&(data->mtd));
271 }
272
273 static const struct of_device_id powernv_flash_match[] = {
274 { .compatible = "ibm,opal-flash" },
275 {}
276 };
277
278 static struct platform_driver powernv_flash_driver = {
279 .driver = {
280 .name = "powernv_flash",
281 .of_match_table = powernv_flash_match,
282 },
283 .remove = powernv_flash_release,
284 .probe = powernv_flash_probe,
285 };
286
287 module_platform_driver(powernv_flash_driver);
288
289 MODULE_DEVICE_TABLE(of, powernv_flash_match);
290 MODULE_LICENSE("GPL");
291 MODULE_AUTHOR("Cyril Bur <cyril.bur@au1.ibm.com>");
292 MODULE_DESCRIPTION("MTD abstraction for OPAL flash");