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
39#include <linux/init.h>
40#include <linux/export.h>
41#include <linux/console.h>
42#include <linux/kobject.h>
43#include <linux/dma-mapping.h>
44#include <linux/interrupt.h>
45#include <linux/of.h>
46#include <linux/slab.h>
47#include <linux/stat.h>
48#include <linux/of_platform.h>
49#include <asm/ibmebus.h>
50#include <asm/machdep.h>
51
52static struct device ibmebus_bus_device = {
53 .init_name = "ibmebus",
54};
55
56struct bus_type ibmebus_bus_type;
57
58
59static const struct of_device_id ibmebus_matches[] __initconst = {
60 { .compatible = "IBM,lhca" },
61 { .compatible = "IBM,lhea" },
62 {},
63};
64
65static void *ibmebus_alloc_coherent(struct device *dev,
66 size_t size,
67 dma_addr_t *dma_handle,
68 gfp_t flag,
69 unsigned long attrs)
70{
71 void *mem;
72
73 mem = kmalloc(size, flag);
74 *dma_handle = (dma_addr_t)mem;
75
76 return mem;
77}
78
79static void ibmebus_free_coherent(struct device *dev,
80 size_t size, void *vaddr,
81 dma_addr_t dma_handle,
82 unsigned long attrs)
83{
84 kfree(vaddr);
85}
86
87static dma_addr_t ibmebus_map_page(struct device *dev,
88 struct page *page,
89 unsigned long offset,
90 size_t size,
91 enum dma_data_direction direction,
92 unsigned long attrs)
93{
94 return (dma_addr_t)(page_address(page) + offset);
95}
96
97static void ibmebus_unmap_page(struct device *dev,
98 dma_addr_t dma_addr,
99 size_t size,
100 enum dma_data_direction direction,
101 unsigned long attrs)
102{
103 return;
104}
105
106static int ibmebus_map_sg(struct device *dev,
107 struct scatterlist *sgl,
108 int nents, enum dma_data_direction direction,
109 unsigned long attrs)
110{
111 struct scatterlist *sg;
112 int i;
113
114 for_each_sg(sgl, sg, nents, i) {
115 sg->dma_address = (dma_addr_t) sg_virt(sg);
116 sg->dma_length = sg->length;
117 }
118
119 return nents;
120}
121
122static void ibmebus_unmap_sg(struct device *dev,
123 struct scatterlist *sg,
124 int nents, enum dma_data_direction direction,
125 unsigned long attrs)
126{
127 return;
128}
129
130static int ibmebus_dma_supported(struct device *dev, u64 mask)
131{
132 return mask == DMA_BIT_MASK(64);
133}
134
135static u64 ibmebus_dma_get_required_mask(struct device *dev)
136{
137 return DMA_BIT_MASK(64);
138}
139
140static const struct dma_map_ops ibmebus_dma_ops = {
141 .alloc = ibmebus_alloc_coherent,
142 .free = ibmebus_free_coherent,
143 .map_sg = ibmebus_map_sg,
144 .unmap_sg = ibmebus_unmap_sg,
145 .dma_supported = ibmebus_dma_supported,
146 .get_required_mask = ibmebus_dma_get_required_mask,
147 .map_page = ibmebus_map_page,
148 .unmap_page = ibmebus_unmap_page,
149};
150
151static int ibmebus_match_path(struct device *dev, const void *data)
152{
153 struct device_node *dn = to_platform_device(dev)->dev.of_node;
154 return (of_find_node_by_path(data) == dn);
155}
156
157static int ibmebus_match_node(struct device *dev, const void *data)
158{
159 return to_platform_device(dev)->dev.of_node == data;
160}
161
162static int ibmebus_create_device(struct device_node *dn)
163{
164 struct platform_device *dev;
165 int ret;
166
167 dev = of_device_alloc(dn, NULL, &ibmebus_bus_device);
168 if (!dev)
169 return -ENOMEM;
170
171 dev->dev.bus = &ibmebus_bus_type;
172 dev->dev.dma_ops = &ibmebus_dma_ops;
173
174 ret = of_device_add(dev);
175 if (ret)
176 platform_device_put(dev);
177 return ret;
178}
179
180static int ibmebus_create_devices(const struct of_device_id *matches)
181{
182 struct device_node *root, *child;
183 struct device *dev;
184 int ret = 0;
185
186 root = of_find_node_by_path("/");
187
188 for_each_child_of_node(root, child) {
189 if (!of_match_node(matches, child))
190 continue;
191
192 dev = bus_find_device(&ibmebus_bus_type, NULL, child,
193 ibmebus_match_node);
194 if (dev) {
195 put_device(dev);
196 continue;
197 }
198
199 ret = ibmebus_create_device(child);
200 if (ret) {
201 printk(KERN_ERR "%s: failed to create device (%i)",
202 __func__, ret);
203 of_node_put(child);
204 break;
205 }
206 }
207
208 of_node_put(root);
209 return ret;
210}
211
212int ibmebus_register_driver(struct platform_driver *drv)
213{
214
215 ibmebus_create_devices(drv->driver.of_match_table);
216
217 drv->driver.bus = &ibmebus_bus_type;
218 return driver_register(&drv->driver);
219}
220EXPORT_SYMBOL(ibmebus_register_driver);
221
222void ibmebus_unregister_driver(struct platform_driver *drv)
223{
224 driver_unregister(&drv->driver);
225}
226EXPORT_SYMBOL(ibmebus_unregister_driver);
227
228int ibmebus_request_irq(u32 ist, irq_handler_t handler,
229 unsigned long irq_flags, const char *devname,
230 void *dev_id)
231{
232 unsigned int irq = irq_create_mapping(NULL, ist);
233
234 if (!irq)
235 return -EINVAL;
236
237 return request_irq(irq, handler, irq_flags, devname, dev_id);
238}
239EXPORT_SYMBOL(ibmebus_request_irq);
240
241void ibmebus_free_irq(u32 ist, void *dev_id)
242{
243 unsigned int irq = irq_find_mapping(NULL, ist);
244
245 free_irq(irq, dev_id);
246 irq_dispose_mapping(irq);
247}
248EXPORT_SYMBOL(ibmebus_free_irq);
249
250static char *ibmebus_chomp(const char *in, size_t count)
251{
252 char *out = kmalloc(count + 1, GFP_KERNEL);
253
254 if (!out)
255 return NULL;
256
257 memcpy(out, in, count);
258 out[count] = '\0';
259 if (out[count - 1] == '\n')
260 out[count - 1] = '\0';
261
262 return out;
263}
264
265static ssize_t ibmebus_store_probe(struct bus_type *bus,
266 const char *buf, size_t count)
267{
268 struct device_node *dn = NULL;
269 struct device *dev;
270 char *path;
271 ssize_t rc = 0;
272
273 path = ibmebus_chomp(buf, count);
274 if (!path)
275 return -ENOMEM;
276
277 dev = bus_find_device(&ibmebus_bus_type, NULL, path,
278 ibmebus_match_path);
279 if (dev) {
280 put_device(dev);
281 printk(KERN_WARNING "%s: %s has already been probed\n",
282 __func__, path);
283 rc = -EEXIST;
284 goto out;
285 }
286
287 if ((dn = of_find_node_by_path(path))) {
288 rc = ibmebus_create_device(dn);
289 of_node_put(dn);
290 } else {
291 printk(KERN_WARNING "%s: no such device node: %s\n",
292 __func__, path);
293 rc = -ENODEV;
294 }
295
296out:
297 kfree(path);
298 if (rc)
299 return rc;
300 return count;
301}
302static BUS_ATTR(probe, 0200, NULL, ibmebus_store_probe);
303
304static ssize_t ibmebus_store_remove(struct bus_type *bus,
305 const char *buf, size_t count)
306{
307 struct device *dev;
308 char *path;
309
310 path = ibmebus_chomp(buf, count);
311 if (!path)
312 return -ENOMEM;
313
314 if ((dev = bus_find_device(&ibmebus_bus_type, NULL, path,
315 ibmebus_match_path))) {
316 of_device_unregister(to_platform_device(dev));
317 put_device(dev);
318
319 kfree(path);
320 return count;
321 } else {
322 printk(KERN_WARNING "%s: %s not on the bus\n",
323 __func__, path);
324
325 kfree(path);
326 return -ENODEV;
327 }
328}
329static BUS_ATTR(remove, 0200, NULL, ibmebus_store_remove);
330
331static struct attribute *ibmbus_bus_attrs[] = {
332 &bus_attr_probe.attr,
333 &bus_attr_remove.attr,
334 NULL,
335};
336ATTRIBUTE_GROUPS(ibmbus_bus);
337
338static int ibmebus_bus_bus_match(struct device *dev, struct device_driver *drv)
339{
340 const struct of_device_id *matches = drv->of_match_table;
341
342 if (!matches)
343 return 0;
344
345 return of_match_device(matches, dev) != NULL;
346}
347
348static int ibmebus_bus_device_probe(struct device *dev)
349{
350 int error = -ENODEV;
351 struct platform_driver *drv;
352 struct platform_device *of_dev;
353
354 drv = to_platform_driver(dev->driver);
355 of_dev = to_platform_device(dev);
356
357 if (!drv->probe)
358 return error;
359
360 of_dev_get(of_dev);
361
362 if (of_driver_match_device(dev, dev->driver))
363 error = drv->probe(of_dev);
364 if (error)
365 of_dev_put(of_dev);
366
367 return error;
368}
369
370static int ibmebus_bus_device_remove(struct device *dev)
371{
372 struct platform_device *of_dev = to_platform_device(dev);
373 struct platform_driver *drv = to_platform_driver(dev->driver);
374
375 if (dev->driver && drv->remove)
376 drv->remove(of_dev);
377 return 0;
378}
379
380static void ibmebus_bus_device_shutdown(struct device *dev)
381{
382 struct platform_device *of_dev = to_platform_device(dev);
383 struct platform_driver *drv = to_platform_driver(dev->driver);
384
385 if (dev->driver && drv->shutdown)
386 drv->shutdown(of_dev);
387}
388
389
390
391
392static ssize_t devspec_show(struct device *dev,
393 struct device_attribute *attr, char *buf)
394{
395 struct platform_device *ofdev;
396
397 ofdev = to_platform_device(dev);
398 return sprintf(buf, "%pOF\n", ofdev->dev.of_node);
399}
400static DEVICE_ATTR_RO(devspec);
401
402static ssize_t name_show(struct device *dev,
403 struct device_attribute *attr, char *buf)
404{
405 struct platform_device *ofdev;
406
407 ofdev = to_platform_device(dev);
408 return sprintf(buf, "%s\n", ofdev->dev.of_node->name);
409}
410static DEVICE_ATTR_RO(name);
411
412static ssize_t modalias_show(struct device *dev,
413 struct device_attribute *attr, char *buf)
414{
415 return of_device_modalias(dev, buf, PAGE_SIZE);
416}
417static DEVICE_ATTR_RO(modalias);
418
419static struct attribute *ibmebus_bus_device_attrs[] = {
420 &dev_attr_devspec.attr,
421 &dev_attr_name.attr,
422 &dev_attr_modalias.attr,
423 NULL,
424};
425ATTRIBUTE_GROUPS(ibmebus_bus_device);
426
427struct bus_type ibmebus_bus_type = {
428 .name = "ibmebus",
429 .uevent = of_device_uevent_modalias,
430 .bus_groups = ibmbus_bus_groups,
431 .match = ibmebus_bus_bus_match,
432 .probe = ibmebus_bus_device_probe,
433 .remove = ibmebus_bus_device_remove,
434 .shutdown = ibmebus_bus_device_shutdown,
435 .dev_groups = ibmebus_bus_device_groups,
436};
437EXPORT_SYMBOL(ibmebus_bus_type);
438
439static int __init ibmebus_bus_init(void)
440{
441 int err;
442
443 printk(KERN_INFO "IBM eBus Device Driver\n");
444
445 err = bus_register(&ibmebus_bus_type);
446 if (err) {
447 printk(KERN_ERR "%s: failed to register IBM eBus.\n",
448 __func__);
449 return err;
450 }
451
452 err = device_register(&ibmebus_bus_device);
453 if (err) {
454 printk(KERN_WARNING "%s: device_register returned %i\n",
455 __func__, err);
456 bus_unregister(&ibmebus_bus_type);
457
458 return err;
459 }
460
461 err = ibmebus_create_devices(ibmebus_matches);
462 if (err) {
463 device_unregister(&ibmebus_bus_device);
464 bus_unregister(&ibmebus_bus_type);
465 return err;
466 }
467
468 return 0;
469}
470machine_postcore_initcall(pseries, ibmebus_bus_init);
471
