2 * IBM PowerPC IBM eBus Infrastructure Support.
4 * Copyright (c) 2005 IBM Corporation
5 * Joachim Fenkes <fenkes@de.ibm.com>
6 * Heiko J Schick <schickhj@de.ibm.com>
10 * This source code is distributed under a dual license of GPL v2.0 and OpenIB
15 * Redistribution and use in source and binary forms, with or without
16 * modification, are permitted provided that the following conditions are met:
18 * Redistributions of source code must retain the above copyright notice, this
19 * list of conditions and the following disclaimer.
21 * Redistributions in binary form must reproduce the above copyright notice,
22 * this list of conditions and the following disclaimer in the documentation
23 * and/or other materials
24 * provided with the distribution.
26 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
27 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
28 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
29 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
30 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
33 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
34 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 * POSSIBILITY OF SUCH DAMAGE.
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>
46 #include <linux/slab.h>
47 #include <linux/stat.h>
48 #include <linux/of_platform.h>
49 #include <asm/ibmebus.h>
51 static struct device ibmebus_bus_device
= { /* fake "parent" device */
52 .init_name
= "ibmebus",
55 struct bus_type ibmebus_bus_type
;
57 /* These devices will automatically be added to the bus during init */
58 static const struct of_device_id ibmebus_matches
[] __initconst
= {
59 { .compatible
= "IBM,lhca" },
60 { .compatible
= "IBM,lhea" },
64 static void *ibmebus_alloc_coherent(struct device
*dev
,
66 dma_addr_t
*dma_handle
,
72 mem
= kmalloc(size
, flag
);
73 *dma_handle
= (dma_addr_t
)mem
;
78 static void ibmebus_free_coherent(struct device
*dev
,
79 size_t size
, void *vaddr
,
80 dma_addr_t dma_handle
,
86 static dma_addr_t
ibmebus_map_page(struct device
*dev
,
90 enum dma_data_direction direction
,
93 return (dma_addr_t
)(page_address(page
) + offset
);
96 static void ibmebus_unmap_page(struct device
*dev
,
99 enum dma_data_direction direction
,
105 static int ibmebus_map_sg(struct device
*dev
,
106 struct scatterlist
*sgl
,
107 int nents
, enum dma_data_direction direction
,
110 struct scatterlist
*sg
;
113 for_each_sg(sgl
, sg
, nents
, i
) {
114 sg
->dma_address
= (dma_addr_t
) sg_virt(sg
);
115 sg
->dma_length
= sg
->length
;
121 static void ibmebus_unmap_sg(struct device
*dev
,
122 struct scatterlist
*sg
,
123 int nents
, enum dma_data_direction direction
,
129 static int ibmebus_dma_supported(struct device
*dev
, u64 mask
)
131 return mask
== DMA_BIT_MASK(64);
134 static u64
ibmebus_dma_get_required_mask(struct device
*dev
)
136 return DMA_BIT_MASK(64);
139 static struct dma_map_ops ibmebus_dma_ops
= {
140 .alloc
= ibmebus_alloc_coherent
,
141 .free
= ibmebus_free_coherent
,
142 .map_sg
= ibmebus_map_sg
,
143 .unmap_sg
= ibmebus_unmap_sg
,
144 .dma_supported
= ibmebus_dma_supported
,
145 .get_required_mask
= ibmebus_dma_get_required_mask
,
146 .map_page
= ibmebus_map_page
,
147 .unmap_page
= ibmebus_unmap_page
,
150 static int ibmebus_match_path(struct device
*dev
, void *data
)
152 struct device_node
*dn
= to_platform_device(dev
)->dev
.of_node
;
153 return (dn
->full_name
&&
154 (strcasecmp((char *)data
, dn
->full_name
) == 0));
157 static int ibmebus_match_node(struct device
*dev
, void *data
)
159 return to_platform_device(dev
)->dev
.of_node
== data
;
162 static int ibmebus_create_device(struct device_node
*dn
)
164 struct platform_device
*dev
;
167 dev
= of_device_alloc(dn
, NULL
, &ibmebus_bus_device
);
171 dev
->dev
.bus
= &ibmebus_bus_type
;
172 dev
->dev
.archdata
.dma_ops
= &ibmebus_dma_ops
;
174 ret
= of_device_add(dev
);
176 platform_device_put(dev
);
180 static int ibmebus_create_devices(const struct of_device_id
*matches
)
182 struct device_node
*root
, *child
;
186 root
= of_find_node_by_path("/");
188 for_each_child_of_node(root
, child
) {
189 if (!of_match_node(matches
, child
))
192 dev
= bus_find_device(&ibmebus_bus_type
, NULL
, child
,
199 ret
= ibmebus_create_device(child
);
201 printk(KERN_ERR
"%s: failed to create device (%i)",
212 int ibmebus_register_driver(struct platform_driver
*drv
)
214 /* If the driver uses devices that ibmebus doesn't know, add them */
215 ibmebus_create_devices(drv
->driver
.of_match_table
);
217 drv
->driver
.bus
= &ibmebus_bus_type
;
218 return driver_register(&drv
->driver
);
220 EXPORT_SYMBOL(ibmebus_register_driver
);
222 void ibmebus_unregister_driver(struct platform_driver
*drv
)
224 driver_unregister(&drv
->driver
);
226 EXPORT_SYMBOL(ibmebus_unregister_driver
);
228 int ibmebus_request_irq(u32 ist
, irq_handler_t handler
,
229 unsigned long irq_flags
, const char *devname
,
232 unsigned int irq
= irq_create_mapping(NULL
, ist
);
237 return request_irq(irq
, handler
, irq_flags
, devname
, dev_id
);
239 EXPORT_SYMBOL(ibmebus_request_irq
);
241 void ibmebus_free_irq(u32 ist
, void *dev_id
)
243 unsigned int irq
= irq_find_mapping(NULL
, ist
);
245 free_irq(irq
, dev_id
);
246 irq_dispose_mapping(irq
);
248 EXPORT_SYMBOL(ibmebus_free_irq
);
250 static char *ibmebus_chomp(const char *in
, size_t count
)
252 char *out
= kmalloc(count
+ 1, GFP_KERNEL
);
257 memcpy(out
, in
, count
);
259 if (out
[count
- 1] == '\n')
260 out
[count
- 1] = '\0';
265 static ssize_t
ibmebus_store_probe(struct bus_type
*bus
,
266 const char *buf
, size_t count
)
268 struct device_node
*dn
= NULL
;
273 path
= ibmebus_chomp(buf
, count
);
277 dev
= bus_find_device(&ibmebus_bus_type
, NULL
, path
,
281 printk(KERN_WARNING
"%s: %s has already been probed\n",
287 if ((dn
= of_find_node_by_path(path
))) {
288 rc
= ibmebus_create_device(dn
);
291 printk(KERN_WARNING
"%s: no such device node: %s\n",
302 static BUS_ATTR(probe
, S_IWUSR
, NULL
, ibmebus_store_probe
);
304 static ssize_t
ibmebus_store_remove(struct bus_type
*bus
,
305 const char *buf
, size_t count
)
310 path
= ibmebus_chomp(buf
, count
);
314 if ((dev
= bus_find_device(&ibmebus_bus_type
, NULL
, path
,
315 ibmebus_match_path
))) {
316 of_device_unregister(to_platform_device(dev
));
322 printk(KERN_WARNING
"%s: %s not on the bus\n",
329 static BUS_ATTR(remove
, S_IWUSR
, NULL
, ibmebus_store_remove
);
331 static struct attribute
*ibmbus_bus_attrs
[] = {
332 &bus_attr_probe
.attr
,
333 &bus_attr_remove
.attr
,
336 ATTRIBUTE_GROUPS(ibmbus_bus
);
338 static int ibmebus_bus_bus_match(struct device
*dev
, struct device_driver
*drv
)
340 const struct of_device_id
*matches
= drv
->of_match_table
;
345 return of_match_device(matches
, dev
) != NULL
;
348 static int ibmebus_bus_device_probe(struct device
*dev
)
351 struct platform_driver
*drv
;
352 struct platform_device
*of_dev
;
354 drv
= to_platform_driver(dev
->driver
);
355 of_dev
= to_platform_device(dev
);
362 if (of_driver_match_device(dev
, dev
->driver
))
363 error
= drv
->probe(of_dev
);
370 static int ibmebus_bus_device_remove(struct device
*dev
)
372 struct platform_device
*of_dev
= to_platform_device(dev
);
373 struct platform_driver
*drv
= to_platform_driver(dev
->driver
);
375 if (dev
->driver
&& drv
->remove
)
380 static void ibmebus_bus_device_shutdown(struct device
*dev
)
382 struct platform_device
*of_dev
= to_platform_device(dev
);
383 struct platform_driver
*drv
= to_platform_driver(dev
->driver
);
385 if (dev
->driver
&& drv
->shutdown
)
386 drv
->shutdown(of_dev
);
390 * ibmebus_bus_device_attrs
392 static ssize_t
devspec_show(struct device
*dev
,
393 struct device_attribute
*attr
, char *buf
)
395 struct platform_device
*ofdev
;
397 ofdev
= to_platform_device(dev
);
398 return sprintf(buf
, "%s\n", ofdev
->dev
.of_node
->full_name
);
401 static ssize_t
name_show(struct device
*dev
,
402 struct device_attribute
*attr
, char *buf
)
404 struct platform_device
*ofdev
;
406 ofdev
= to_platform_device(dev
);
407 return sprintf(buf
, "%s\n", ofdev
->dev
.of_node
->name
);
410 static ssize_t
modalias_show(struct device
*dev
,
411 struct device_attribute
*attr
, char *buf
)
413 ssize_t len
= of_device_get_modalias(dev
, buf
, PAGE_SIZE
- 2);
419 static struct device_attribute ibmebus_bus_device_attrs
[] = {
426 struct bus_type ibmebus_bus_type
= {
428 .uevent
= of_device_uevent_modalias
,
429 .bus_groups
= ibmbus_bus_groups
,
430 .match
= ibmebus_bus_bus_match
,
431 .probe
= ibmebus_bus_device_probe
,
432 .remove
= ibmebus_bus_device_remove
,
433 .shutdown
= ibmebus_bus_device_shutdown
,
434 .dev_attrs
= ibmebus_bus_device_attrs
,
436 EXPORT_SYMBOL(ibmebus_bus_type
);
438 static int __init
ibmebus_bus_init(void)
442 printk(KERN_INFO
"IBM eBus Device Driver\n");
444 err
= bus_register(&ibmebus_bus_type
);
446 printk(KERN_ERR
"%s: failed to register IBM eBus.\n",
451 err
= device_register(&ibmebus_bus_device
);
453 printk(KERN_WARNING
"%s: device_register returned %i\n",
455 bus_unregister(&ibmebus_bus_type
);
460 err
= ibmebus_create_devices(ibmebus_matches
);
462 device_unregister(&ibmebus_bus_device
);
463 bus_unregister(&ibmebus_bus_type
);
469 postcore_initcall(ibmebus_bus_init
);