blob: 2e16ca5778a3ac40daf119eb357fc700debbd7b1 [file] [log] [blame]
Heiko J Schickd7a30102005-11-16 08:56:43 +01001/*
2 * IBM PowerPC IBM eBus Infrastructure Support.
3 *
4 * Copyright (c) 2005 IBM Corporation
Joachim Fenkes6bccf752007-03-09 19:00:32 +01005 * Joachim Fenkes <fenkes@de.ibm.com>
Heiko J Schickd7a30102005-11-16 08:56:43 +01006 * Heiko J Schick <schickhj@de.ibm.com>
Joachim Fenkesa8308802007-03-09 18:56:46 +01007 *
Heiko J Schickd7a30102005-11-16 08:56:43 +01008 * All rights reserved.
9 *
Joachim Fenkesa8308802007-03-09 18:56:46 +010010 * This source code is distributed under a dual license of GPL v2.0 and OpenIB
11 * BSD.
Heiko J Schickd7a30102005-11-16 08:56:43 +010012 *
13 * OpenIB BSD License
14 *
Joachim Fenkesa8308802007-03-09 18:56:46 +010015 * Redistribution and use in source and binary forms, with or without
16 * modification, are permitted provided that the following conditions are met:
Heiko J Schickd7a30102005-11-16 08:56:43 +010017 *
Joachim Fenkesa8308802007-03-09 18:56:46 +010018 * Redistributions of source code must retain the above copyright notice, this
19 * list of conditions and the following disclaimer.
Heiko J Schickd7a30102005-11-16 08:56:43 +010020 *
Joachim Fenkesa8308802007-03-09 18:56:46 +010021 * Redistributions in binary form must reproduce the above copyright notice,
22 * this list of conditions and the following disclaimer in the documentation
Heiko J Schickd7a30102005-11-16 08:56:43 +010023 * and/or other materials
Joachim Fenkesa8308802007-03-09 18:56:46 +010024 * provided with the distribution.
Heiko J Schickd7a30102005-11-16 08:56:43 +010025 *
Joachim Fenkesa8308802007-03-09 18:56:46 +010026 * 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
Heiko J Schickd7a30102005-11-16 08:56:43 +010032 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
33 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
Joachim Fenkesa8308802007-03-09 18:56:46 +010034 * 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
Heiko J Schickd7a30102005-11-16 08:56:43 +010036 * POSSIBILITY OF SUCH DAMAGE.
37 */
38
39#include <linux/init.h>
40#include <linux/console.h>
41#include <linux/kobject.h>
42#include <linux/dma-mapping.h>
43#include <linux/interrupt.h>
44#include <asm/ibmebus.h>
45#include <asm/abs_addr.h>
46
Joachim Fenkes6bccf752007-03-09 19:00:32 +010047static struct device ibmebus_bus_device = { /* fake "parent" device */
48 .bus_id = "ibmebus",
Heiko J Schickd7a30102005-11-16 08:56:43 +010049};
50
Joachim Fenkes6bccf752007-03-09 19:00:32 +010051struct bus_type ibmebus_bus_type;
52
Heiko J Schickd7a30102005-11-16 08:56:43 +010053static void *ibmebus_alloc_coherent(struct device *dev,
54 size_t size,
55 dma_addr_t *dma_handle,
56 gfp_t flag)
57{
58 void *mem;
Joachim Fenkesa8308802007-03-09 18:56:46 +010059
Heiko J Schickd7a30102005-11-16 08:56:43 +010060 mem = kmalloc(size, flag);
61 *dma_handle = (dma_addr_t)mem;
62
63 return mem;
64}
65
66static void ibmebus_free_coherent(struct device *dev,
Joachim Fenkesa8308802007-03-09 18:56:46 +010067 size_t size, void *vaddr,
Heiko J Schickd7a30102005-11-16 08:56:43 +010068 dma_addr_t dma_handle)
69{
70 kfree(vaddr);
71}
72
73static dma_addr_t ibmebus_map_single(struct device *dev,
74 void *ptr,
75 size_t size,
76 enum dma_data_direction direction)
77{
78 return (dma_addr_t)(ptr);
79}
80
81static void ibmebus_unmap_single(struct device *dev,
82 dma_addr_t dma_addr,
Joachim Fenkesa8308802007-03-09 18:56:46 +010083 size_t size,
Heiko J Schickd7a30102005-11-16 08:56:43 +010084 enum dma_data_direction direction)
85{
86 return;
87}
88
89static int ibmebus_map_sg(struct device *dev,
Jens Axboe78bdc312007-10-12 13:44:12 +020090 struct scatterlist *sgl,
Heiko J Schickd7a30102005-11-16 08:56:43 +010091 int nents, enum dma_data_direction direction)
92{
Jens Axboe78bdc312007-10-12 13:44:12 +020093 struct scatterlist *sg;
Heiko J Schickd7a30102005-11-16 08:56:43 +010094 int i;
Joachim Fenkesa8308802007-03-09 18:56:46 +010095
Jens Axboe78bdc312007-10-12 13:44:12 +020096 for_each_sg(sgl, sg, nents, i) {
97 sg->dma_address = (dma_addr_t)page_address(sg->page)
98 + sg->offset;
99 sg->dma_length = sg->length;
Heiko J Schickd7a30102005-11-16 08:56:43 +0100100 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100101
Heiko J Schickd7a30102005-11-16 08:56:43 +0100102 return nents;
103}
104
105static void ibmebus_unmap_sg(struct device *dev,
106 struct scatterlist *sg,
107 int nents, enum dma_data_direction direction)
108{
109 return;
110}
111
112static int ibmebus_dma_supported(struct device *dev, u64 mask)
113{
114 return 1;
115}
116
Benjamin Herrenschmidt12d04ee2006-11-11 17:25:02 +1100117static struct dma_mapping_ops ibmebus_dma_ops = {
Heiko J Schickd7a30102005-11-16 08:56:43 +0100118 .alloc_coherent = ibmebus_alloc_coherent,
119 .free_coherent = ibmebus_free_coherent,
120 .map_single = ibmebus_map_single,
121 .unmap_single = ibmebus_unmap_single,
122 .map_sg = ibmebus_map_sg,
123 .unmap_sg = ibmebus_unmap_sg,
124 .dma_supported = ibmebus_dma_supported,
125};
126
127static int ibmebus_bus_probe(struct device *dev)
128{
129 struct ibmebus_dev *ibmebusdev = to_ibmebus_dev(dev);
130 struct ibmebus_driver *ibmebusdrv = to_ibmebus_driver(dev->driver);
131 const struct of_device_id *id;
132 int error = -ENODEV;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100133
Heiko J Schickd7a30102005-11-16 08:56:43 +0100134 if (!ibmebusdrv->probe)
135 return error;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100136
Heiko J Schickd7a30102005-11-16 08:56:43 +0100137 id = of_match_device(ibmebusdrv->id_table, &ibmebusdev->ofdev);
138 if (id) {
139 error = ibmebusdrv->probe(ibmebusdev, id);
140 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100141
Heiko J Schickd7a30102005-11-16 08:56:43 +0100142 return error;
143}
144
145static int ibmebus_bus_remove(struct device *dev)
146{
147 struct ibmebus_dev *ibmebusdev = to_ibmebus_dev(dev);
148 struct ibmebus_driver *ibmebusdrv = to_ibmebus_driver(dev->driver);
Joachim Fenkesa8308802007-03-09 18:56:46 +0100149
Heiko J Schickd7a30102005-11-16 08:56:43 +0100150 if (ibmebusdrv->remove) {
151 return ibmebusdrv->remove(ibmebusdev);
152 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100153
Heiko J Schickd7a30102005-11-16 08:56:43 +0100154 return 0;
155}
156
157static void __devinit ibmebus_dev_release(struct device *dev)
158{
159 of_node_put(to_ibmebus_dev(dev)->ofdev.node);
160 kfree(to_ibmebus_dev(dev));
161}
162
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100163static int __devinit ibmebus_register_device_common(
Jeremy Kerra7f67bd2006-07-12 15:35:54 +1000164 struct ibmebus_dev *dev, const char *name)
Heiko J Schickd7a30102005-11-16 08:56:43 +0100165{
166 int err = 0;
167
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100168 dev->ofdev.dev.parent = &ibmebus_bus_device;
Heiko J Schickd7a30102005-11-16 08:56:43 +0100169 dev->ofdev.dev.bus = &ibmebus_bus_type;
170 dev->ofdev.dev.release = ibmebus_dev_release;
171
Benjamin Herrenschmidt12d04ee2006-11-11 17:25:02 +1100172 dev->ofdev.dev.archdata.of_node = dev->ofdev.node;
173 dev->ofdev.dev.archdata.dma_ops = &ibmebus_dma_ops;
174 dev->ofdev.dev.archdata.numa_node = of_node_to_nid(dev->ofdev.node);
175
Heiko J Schickd7a30102005-11-16 08:56:43 +0100176 /* An ibmebusdev is based on a of_device. We have to change the
Joachim Fenkesa8308802007-03-09 18:56:46 +0100177 * bus type to use our own DMA mapping operations.
178 */
Heiko J Schickd7a30102005-11-16 08:56:43 +0100179 if ((err = of_device_register(&dev->ofdev)) != 0) {
180 printk(KERN_ERR "%s: failed to register device (%d).\n",
181 __FUNCTION__, err);
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100182 return -ENODEV;
Heiko J Schickd7a30102005-11-16 08:56:43 +0100183 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100184
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100185 return 0;
Heiko J Schickd7a30102005-11-16 08:56:43 +0100186}
187
188static struct ibmebus_dev* __devinit ibmebus_register_device_node(
189 struct device_node *dn)
190{
191 struct ibmebus_dev *dev;
Joachim Fenkesd8612412007-08-29 18:15:17 +0200192 int i, len, bus_len;
Heiko J Schickd7a30102005-11-16 08:56:43 +0100193
Yan Burmanf8485352006-12-02 13:26:57 +0200194 dev = kzalloc(sizeof(struct ibmebus_dev), GFP_KERNEL);
Joachim Fenkesd8612412007-08-29 18:15:17 +0200195 if (!dev)
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100196 return ERR_PTR(-ENOMEM);
Heiko J Schickd7a30102005-11-16 08:56:43 +0100197
198 dev->ofdev.node = of_node_get(dn);
Joachim Fenkesa8308802007-03-09 18:56:46 +0100199
Joachim Fenkesd8612412007-08-29 18:15:17 +0200200 len = strlen(dn->full_name + 1);
201 bus_len = min(len, BUS_ID_SIZE - 1);
202 memcpy(dev->ofdev.dev.bus_id, dn->full_name + 1
203 + (len - bus_len), bus_len);
204 for (i = 0; i < bus_len; i++)
205 if (dev->ofdev.dev.bus_id[i] == '/')
206 dev->ofdev.dev.bus_id[i] = '_';
Heiko J Schickd7a30102005-11-16 08:56:43 +0100207
208 /* Register with generic device framework. */
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100209 if (ibmebus_register_device_common(dev, dn->name) != 0) {
Heiko J Schickd7a30102005-11-16 08:56:43 +0100210 kfree(dev);
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100211 return ERR_PTR(-ENODEV);
Heiko J Schickd7a30102005-11-16 08:56:43 +0100212 }
213
214 return dev;
215}
216
217static void ibmebus_probe_of_nodes(char* name)
218{
219 struct device_node *dn = NULL;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100220
Heiko J Schickd7a30102005-11-16 08:56:43 +0100221 while ((dn = of_find_node_by_name(dn, name))) {
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100222 if (IS_ERR(ibmebus_register_device_node(dn))) {
Heiko J Schickd7a30102005-11-16 08:56:43 +0100223 of_node_put(dn);
Heiko J Schickd7a30102005-11-16 08:56:43 +0100224 return;
225 }
226 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100227
Heiko J Schickd7a30102005-11-16 08:56:43 +0100228 of_node_put(dn);
Joachim Fenkesa8308802007-03-09 18:56:46 +0100229
Heiko J Schickd7a30102005-11-16 08:56:43 +0100230 return;
231}
232
233static void ibmebus_add_devices_by_id(struct of_device_id *idt)
234{
235 while (strlen(idt->name) > 0) {
236 ibmebus_probe_of_nodes(idt->name);
237 idt++;
238 }
239
240 return;
241}
242
Joachim Fenkes07277022007-03-22 17:00:46 +0100243static int ibmebus_match_name(struct device *dev, void *data)
Heiko J Schickd7a30102005-11-16 08:56:43 +0100244{
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100245 const struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
Stephen Rothwelle2eb6392007-04-03 22:26:41 +1000246 const char *name;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100247
Stephen Rothwelle2eb6392007-04-03 22:26:41 +1000248 name = of_get_property(ebus_dev->ofdev.node, "name", NULL);
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100249
Stephen Rothwelle2eb6392007-04-03 22:26:41 +1000250 if (name && (strcmp(data, name) == 0))
Heiko J Schickd7a30102005-11-16 08:56:43 +0100251 return 1;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100252
Heiko J Schickd7a30102005-11-16 08:56:43 +0100253 return 0;
254}
255
256static int ibmebus_unregister_device(struct device *dev)
257{
Heiko J Schickd7a30102005-11-16 08:56:43 +0100258 of_device_unregister(to_of_device(dev));
259
260 return 0;
261}
262
263static void ibmebus_remove_devices_by_id(struct of_device_id *idt)
264{
265 struct device *dev;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100266
Heiko J Schickd7a30102005-11-16 08:56:43 +0100267 while (strlen(idt->name) > 0) {
Joachim Fenkesa8308802007-03-09 18:56:46 +0100268 while ((dev = bus_find_device(&ibmebus_bus_type, NULL,
Heiko J Schickd7a30102005-11-16 08:56:43 +0100269 (void*)idt->name,
Joachim Fenkes07277022007-03-22 17:00:46 +0100270 ibmebus_match_name))) {
Heiko J Schickd7a30102005-11-16 08:56:43 +0100271 ibmebus_unregister_device(dev);
272 }
273 idt++;
Heiko J Schickd7a30102005-11-16 08:56:43 +0100274 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100275
Heiko J Schickd7a30102005-11-16 08:56:43 +0100276 return;
277}
278
279int ibmebus_register_driver(struct ibmebus_driver *drv)
280{
281 int err = 0;
282
283 drv->driver.name = drv->name;
284 drv->driver.bus = &ibmebus_bus_type;
285 drv->driver.probe = ibmebus_bus_probe;
286 drv->driver.remove = ibmebus_bus_remove;
287
288 if ((err = driver_register(&drv->driver) != 0))
289 return err;
290
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100291 /* remove all supported devices first, in case someone
292 * probed them manually before registering the driver */
293 ibmebus_remove_devices_by_id(drv->id_table);
Heiko J Schickd7a30102005-11-16 08:56:43 +0100294 ibmebus_add_devices_by_id(drv->id_table);
Joachim Fenkesa8308802007-03-09 18:56:46 +0100295
Heiko J Schickd7a30102005-11-16 08:56:43 +0100296 return 0;
297}
298EXPORT_SYMBOL(ibmebus_register_driver);
299
300void ibmebus_unregister_driver(struct ibmebus_driver *drv)
Joachim Fenkesa8308802007-03-09 18:56:46 +0100301{
Heiko J Schickd7a30102005-11-16 08:56:43 +0100302 driver_unregister(&drv->driver);
303 ibmebus_remove_devices_by_id(drv->id_table);
304}
305EXPORT_SYMBOL(ibmebus_unregister_driver);
306
307int ibmebus_request_irq(struct ibmebus_dev *dev,
Joachim Fenkesa8308802007-03-09 18:56:46 +0100308 u32 ist,
David Howells40220c12006-10-09 12:19:47 +0100309 irq_handler_t handler,
Heiko J Schickd7a30102005-11-16 08:56:43 +0100310 unsigned long irq_flags, const char * devname,
311 void *dev_id)
312{
Benjamin Herrenschmidt6e99e452006-07-10 04:44:42 -0700313 unsigned int irq = irq_create_mapping(NULL, ist);
Joachim Fenkesa8308802007-03-09 18:56:46 +0100314
Heiko J Schickd7a30102005-11-16 08:56:43 +0100315 if (irq == NO_IRQ)
316 return -EINVAL;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100317
Heiko J Schickd7a30102005-11-16 08:56:43 +0100318 return request_irq(irq, handler,
319 irq_flags, devname, dev_id);
320}
321EXPORT_SYMBOL(ibmebus_request_irq);
322
323void ibmebus_free_irq(struct ibmebus_dev *dev, u32 ist, void *dev_id)
324{
Benjamin Herrenschmidt0ebfff12006-07-03 21:36:01 +1000325 unsigned int irq = irq_find_mapping(NULL, ist);
Joachim Fenkesa8308802007-03-09 18:56:46 +0100326
Heiko J Schickd7a30102005-11-16 08:56:43 +0100327 free_irq(irq, dev_id);
Heiko J Schickd7a30102005-11-16 08:56:43 +0100328}
329EXPORT_SYMBOL(ibmebus_free_irq);
330
331static int ibmebus_bus_match(struct device *dev, struct device_driver *drv)
Joachim Fenkesa8308802007-03-09 18:56:46 +0100332{
Heiko J Schickd7a30102005-11-16 08:56:43 +0100333 const struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
334 struct ibmebus_driver *ebus_drv = to_ibmebus_driver(drv);
335 const struct of_device_id *ids = ebus_drv->id_table;
336 const struct of_device_id *found_id;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100337
Heiko J Schickd7a30102005-11-16 08:56:43 +0100338 if (!ids)
339 return 0;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100340
Heiko J Schickd7a30102005-11-16 08:56:43 +0100341 found_id = of_match_device(ids, &ebus_dev->ofdev);
342 if (found_id)
343 return 1;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100344
Heiko J Schickd7a30102005-11-16 08:56:43 +0100345 return 0;
346}
347
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100348static ssize_t name_show(struct device *dev,
349 struct device_attribute *attr, char *buf)
350{
351 struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
Stephen Rothwelle2eb6392007-04-03 22:26:41 +1000352 const char *name = of_get_property(ebus_dev->ofdev.node, "name", NULL);
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100353 return sprintf(buf, "%s\n", name);
354}
355
356static struct device_attribute ibmebus_dev_attrs[] = {
357 __ATTR_RO(name),
358 __ATTR_NULL
359};
360
Joachim Fenkes07277022007-03-22 17:00:46 +0100361static int ibmebus_match_path(struct device *dev, void *data)
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100362{
Joachim Fenkes07277022007-03-22 17:00:46 +0100363 int rc;
364 struct device_node *dn =
365 of_node_get(to_ibmebus_dev(dev)->ofdev.node);
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100366
Joachim Fenkes07277022007-03-22 17:00:46 +0100367 rc = (dn->full_name && (strcasecmp((char*)data, dn->full_name) == 0));
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100368
Joachim Fenkes07277022007-03-22 17:00:46 +0100369 of_node_put(dn);
370 return rc;
371}
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100372
Joachim Fenkes07277022007-03-22 17:00:46 +0100373static char *ibmebus_chomp(const char *in, size_t count)
374{
Jesper Juhl61a564f2007-08-24 09:45:08 +1000375 char *out = kmalloc(count + 1, GFP_KERNEL);
376
Joachim Fenkes07277022007-03-22 17:00:46 +0100377 if (!out)
378 return NULL;
379
380 memcpy(out, in, count);
381 out[count] = '\0';
382 if (out[count - 1] == '\n')
383 out[count - 1] = '\0';
384
385 return out;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100386}
387
388static ssize_t ibmebus_store_probe(struct bus_type *bus,
389 const char *buf, size_t count)
390{
391 struct device_node *dn = NULL;
392 struct ibmebus_dev *dev;
Joachim Fenkes07277022007-03-22 17:00:46 +0100393 char *path;
394 ssize_t rc;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100395
Joachim Fenkes07277022007-03-22 17:00:46 +0100396 path = ibmebus_chomp(buf, count);
397 if (!path)
398 return -ENOMEM;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100399
Joachim Fenkes07277022007-03-22 17:00:46 +0100400 if (bus_find_device(&ibmebus_bus_type, NULL, path,
Joachim Fenkes74c9b992007-09-26 19:46:34 +1000401 ibmebus_match_path)) {
Joachim Fenkes07277022007-03-22 17:00:46 +0100402 printk(KERN_WARNING "%s: %s has already been probed\n",
403 __FUNCTION__, path);
Joachim Fenkes74c9b992007-09-26 19:46:34 +1000404 rc = -EEXIST;
Joachim Fenkes07277022007-03-22 17:00:46 +0100405 goto out;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100406 }
407
Joachim Fenkes07277022007-03-22 17:00:46 +0100408 if ((dn = of_find_node_by_path(path))) {
409 dev = ibmebus_register_device_node(dn);
410 of_node_put(dn);
411 rc = IS_ERR(dev) ? PTR_ERR(dev) : count;
412 } else {
413 printk(KERN_WARNING "%s: no such device node: %s\n",
414 __FUNCTION__, path);
415 rc = -ENODEV;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100416 }
417
Joachim Fenkes07277022007-03-22 17:00:46 +0100418out:
419 kfree(path);
420 return rc;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100421}
422
423static ssize_t ibmebus_store_remove(struct bus_type *bus,
424 const char *buf, size_t count)
425{
426 struct device *dev;
Joachim Fenkes07277022007-03-22 17:00:46 +0100427 char *path;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100428
Joachim Fenkes07277022007-03-22 17:00:46 +0100429 path = ibmebus_chomp(buf, count);
430 if (!path)
431 return -ENOMEM;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100432
Joachim Fenkes07277022007-03-22 17:00:46 +0100433 if ((dev = bus_find_device(&ibmebus_bus_type, NULL, path,
434 ibmebus_match_path))) {
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100435 ibmebus_unregister_device(dev);
Joachim Fenkes07277022007-03-22 17:00:46 +0100436
437 kfree(path);
438 return count;
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100439 } else {
Joachim Fenkes07277022007-03-22 17:00:46 +0100440 printk(KERN_WARNING "%s: %s not on the bus\n",
441 __FUNCTION__, path);
442
443 kfree(path);
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100444 return -ENODEV;
445 }
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100446}
447
448static struct bus_attribute ibmebus_bus_attrs[] = {
449 __ATTR(probe, S_IWUSR, NULL, ibmebus_store_probe),
450 __ATTR(remove, S_IWUSR, NULL, ibmebus_store_remove),
451 __ATTR_NULL
452};
453
Heiko J Schickd7a30102005-11-16 08:56:43 +0100454struct bus_type ibmebus_bus_type = {
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100455 .name = "ibmebus",
456 .match = ibmebus_bus_match,
457 .dev_attrs = ibmebus_dev_attrs,
458 .bus_attrs = ibmebus_bus_attrs
Heiko J Schickd7a30102005-11-16 08:56:43 +0100459};
460EXPORT_SYMBOL(ibmebus_bus_type);
461
462static int __init ibmebus_bus_init(void)
463{
464 int err;
Joachim Fenkesa8308802007-03-09 18:56:46 +0100465
Heiko J Schickd7a30102005-11-16 08:56:43 +0100466 printk(KERN_INFO "IBM eBus Device Driver\n");
Joachim Fenkesa8308802007-03-09 18:56:46 +0100467
Heiko J Schickd7a30102005-11-16 08:56:43 +0100468 err = bus_register(&ibmebus_bus_type);
469 if (err) {
470 printk(KERN_ERR ":%s: failed to register IBM eBus.\n",
471 __FUNCTION__);
472 return err;
473 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100474
Joachim Fenkes6bccf752007-03-09 19:00:32 +0100475 err = device_register(&ibmebus_bus_device);
Heiko J Schickd7a30102005-11-16 08:56:43 +0100476 if (err) {
Joachim Fenkesa8308802007-03-09 18:56:46 +0100477 printk(KERN_WARNING "%s: device_register returned %i\n",
Heiko J Schickd7a30102005-11-16 08:56:43 +0100478 __FUNCTION__, err);
479 bus_unregister(&ibmebus_bus_type);
480
481 return err;
482 }
Joachim Fenkesa8308802007-03-09 18:56:46 +0100483
Heiko J Schickd7a30102005-11-16 08:56:43 +0100484 return 0;
485}
486__initcall(ibmebus_bus_init);