Pull bugfix into test branch
[linux-2.6] / arch / powerpc / kernel / ibmebus.c
1 /*
2  * IBM PowerPC IBM eBus Infrastructure Support.
3  *
4  * Copyright (c) 2005 IBM Corporation
5  *  Heiko J Schick <schickhj@de.ibm.com>
6  *    
7  * All rights reserved.
8  *
9  * This source code is distributed under a dual license of GPL v2.0 and OpenIB 
10  * BSD. 
11  *
12  * OpenIB BSD License
13  *
14  * Redistribution and use in source and binary forms, with or without 
15  * modification, are permitted provided that the following conditions are met: 
16  *
17  * Redistributions of source code must retain the above copyright notice, this 
18  * list of conditions and the following disclaimer. 
19  *
20  * Redistributions in binary form must reproduce the above copyright notice, 
21  * this list of conditions and the following disclaimer in the documentation 
22  * and/or other materials
23  * provided with the distribution. 
24  *
25  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 
26  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 
27  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 
28  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 
29  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 
30  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 
31  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
32  * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
33  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 
34  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 
35  * POSSIBILITY OF SUCH DAMAGE.
36  */
37
38 #include <linux/init.h>
39 #include <linux/console.h>
40 #include <linux/kobject.h>
41 #include <linux/dma-mapping.h>
42 #include <linux/interrupt.h>
43 #include <asm/ibmebus.h>
44 #include <asm/abs_addr.h>
45
46 static struct ibmebus_dev ibmebus_bus_device = { /* fake "parent" device */
47         .name = ibmebus_bus_device.ofdev.dev.bus_id,
48         .ofdev.dev.bus_id = "ibmebus",
49         .ofdev.dev.bus    = &ibmebus_bus_type,
50 };
51
52 static void *ibmebus_alloc_coherent(struct device *dev,
53                                     size_t size,
54                                     dma_addr_t *dma_handle,
55                                     gfp_t flag)
56 {
57         void *mem;
58         
59         mem = kmalloc(size, flag);
60         *dma_handle = (dma_addr_t)mem;
61
62         return mem;
63 }
64
65 static void ibmebus_free_coherent(struct device *dev,
66                                   size_t size, void *vaddr, 
67                                   dma_addr_t dma_handle)
68 {
69         kfree(vaddr);
70 }
71
72 static dma_addr_t ibmebus_map_single(struct device *dev,
73                                      void *ptr,
74                                      size_t size,
75                                      enum dma_data_direction direction)
76 {
77         return (dma_addr_t)(ptr);
78 }
79
80 static void ibmebus_unmap_single(struct device *dev,
81                                  dma_addr_t dma_addr,
82                                  size_t size, 
83                                  enum dma_data_direction direction)
84 {
85         return;
86 }
87
88 static int ibmebus_map_sg(struct device *dev,
89                           struct scatterlist *sg,
90                           int nents, enum dma_data_direction direction)
91 {
92         int i;
93         
94         for (i = 0; i < nents; i++) {
95                 sg[i].dma_address = (dma_addr_t)page_address(sg[i].page) 
96                         + sg[i].offset;
97                 sg[i].dma_length = sg[i].length;
98         }
99         
100         return nents;
101 }
102
103 static void ibmebus_unmap_sg(struct device *dev,
104                              struct scatterlist *sg,
105                              int nents, enum dma_data_direction direction)
106 {
107         return;
108 }
109
110 static int ibmebus_dma_supported(struct device *dev, u64 mask)
111 {
112         return 1;
113 }
114
115 static struct dma_mapping_ops ibmebus_dma_ops = {
116         .alloc_coherent = ibmebus_alloc_coherent,
117         .free_coherent  = ibmebus_free_coherent,
118         .map_single     = ibmebus_map_single,
119         .unmap_single   = ibmebus_unmap_single,
120         .map_sg         = ibmebus_map_sg,
121         .unmap_sg       = ibmebus_unmap_sg,
122         .dma_supported  = ibmebus_dma_supported,
123 };
124
125 static int ibmebus_bus_probe(struct device *dev)
126 {
127         struct ibmebus_dev *ibmebusdev    = to_ibmebus_dev(dev);
128         struct ibmebus_driver *ibmebusdrv = to_ibmebus_driver(dev->driver);
129         const struct of_device_id *id;
130         int error = -ENODEV;
131         
132         if (!ibmebusdrv->probe)
133                 return error;
134         
135         id = of_match_device(ibmebusdrv->id_table, &ibmebusdev->ofdev);
136         if (id) {
137                 error = ibmebusdrv->probe(ibmebusdev, id);
138         }
139         
140         return error;
141 }
142
143 static int ibmebus_bus_remove(struct device *dev)
144 {
145         struct ibmebus_dev *ibmebusdev    = to_ibmebus_dev(dev);
146         struct ibmebus_driver *ibmebusdrv = to_ibmebus_driver(dev->driver);
147         
148         if (ibmebusdrv->remove) {
149                 return ibmebusdrv->remove(ibmebusdev);
150         }
151         
152         return 0;
153 }
154
155 static void __devinit ibmebus_dev_release(struct device *dev)
156 {
157         of_node_put(to_ibmebus_dev(dev)->ofdev.node);
158         kfree(to_ibmebus_dev(dev));
159 }
160
161 static ssize_t ibmebusdev_show_name(struct device *dev, 
162                                     struct device_attribute *attr, char *buf)
163 {
164         return sprintf(buf, "%s\n", to_ibmebus_dev(dev)->name);
165 }
166 static DEVICE_ATTR(name, S_IRUSR | S_IRGRP | S_IROTH, ibmebusdev_show_name, 
167                    NULL);
168
169 static struct ibmebus_dev* __devinit ibmebus_register_device_common(
170         struct ibmebus_dev *dev, const char *name)
171 {
172         int err = 0;
173
174         dev->name = name;
175         dev->ofdev.dev.parent  = &ibmebus_bus_device.ofdev.dev;
176         dev->ofdev.dev.bus     = &ibmebus_bus_type;
177         dev->ofdev.dev.release = ibmebus_dev_release;
178
179         dev->ofdev.dev.archdata.of_node = dev->ofdev.node;
180         dev->ofdev.dev.archdata.dma_ops = &ibmebus_dma_ops;
181         dev->ofdev.dev.archdata.numa_node = of_node_to_nid(dev->ofdev.node);
182
183         /* An ibmebusdev is based on a of_device. We have to change the
184          * bus type to use our own DMA mapping operations. 
185          */       
186         if ((err = of_device_register(&dev->ofdev)) != 0) {
187                 printk(KERN_ERR "%s: failed to register device (%d).\n",
188                        __FUNCTION__, err);
189                 return NULL;
190         }
191         
192         device_create_file(&dev->ofdev.dev, &dev_attr_name);
193         
194         return dev;
195 }
196
197 static struct ibmebus_dev* __devinit ibmebus_register_device_node(
198         struct device_node *dn)
199 {
200         struct ibmebus_dev *dev;
201         const char *loc_code;
202         int length;
203
204         loc_code = get_property(dn, "ibm,loc-code", NULL);
205         if (!loc_code) {
206                 printk(KERN_WARNING "%s: node %s missing 'ibm,loc-code'\n",
207                        __FUNCTION__, dn->name ? dn->name : "<unknown>");
208                 return NULL;
209         }
210         
211         if (strlen(loc_code) == 0) {
212                 printk(KERN_WARNING "%s: 'ibm,loc-code' is invalid\n",
213                        __FUNCTION__);
214                 return NULL;
215         }
216
217         dev = kzalloc(sizeof(struct ibmebus_dev), GFP_KERNEL);
218         if (!dev) {
219                 return NULL;
220         }
221
222         dev->ofdev.node = of_node_get(dn);
223        
224         length = strlen(loc_code);
225         memcpy(dev->ofdev.dev.bus_id, loc_code 
226                 + (length - min(length, BUS_ID_SIZE - 1)), 
227                 min(length, BUS_ID_SIZE - 1));
228
229         /* Register with generic device framework. */
230         if (ibmebus_register_device_common(dev, dn->name) == NULL) {
231                 kfree(dev);
232                 return NULL;
233         }
234
235         return dev;
236 }
237
238 static void ibmebus_probe_of_nodes(char* name)
239 {
240         struct device_node *dn = NULL;
241         
242         while ((dn = of_find_node_by_name(dn, name))) {
243                 if (ibmebus_register_device_node(dn) == NULL) {
244                         of_node_put(dn);
245                         
246                         return;
247                 }
248         }
249         
250         of_node_put(dn);
251         
252         return;
253 }
254
255 static void ibmebus_add_devices_by_id(struct of_device_id *idt)
256 {
257         while (strlen(idt->name) > 0) {
258                 ibmebus_probe_of_nodes(idt->name);
259                 idt++;
260         }
261
262         return;
263 }
264
265 static int ibmebus_match_helper(struct device *dev, void *data)
266 {
267         if (strcmp((char*)data, to_ibmebus_dev(dev)->name) == 0)
268                 return 1;
269         
270         return 0;
271 }
272
273 static int ibmebus_unregister_device(struct device *dev)
274 {
275         device_remove_file(dev, &dev_attr_name);
276         of_device_unregister(to_of_device(dev));
277
278         return 0;
279 }
280
281 static void ibmebus_remove_devices_by_id(struct of_device_id *idt)
282 {
283         struct device *dev;
284         
285         while (strlen(idt->name) > 0) {
286                 while ((dev = bus_find_device(&ibmebus_bus_type, NULL, 
287                                               (void*)idt->name,
288                                               ibmebus_match_helper))) {
289                         ibmebus_unregister_device(dev);
290                 }
291                 idt++;
292                 
293         }
294         
295         return;
296 }
297
298 int ibmebus_register_driver(struct ibmebus_driver *drv)
299 {
300         int err = 0;
301
302         drv->driver.name   = drv->name;
303         drv->driver.bus    = &ibmebus_bus_type;
304         drv->driver.probe  = ibmebus_bus_probe;
305         drv->driver.remove = ibmebus_bus_remove;
306
307         if ((err = driver_register(&drv->driver) != 0))
308                 return err;
309
310         ibmebus_add_devices_by_id(drv->id_table);
311         
312         return 0;
313 }
314 EXPORT_SYMBOL(ibmebus_register_driver);
315
316 void ibmebus_unregister_driver(struct ibmebus_driver *drv)
317 {       
318         driver_unregister(&drv->driver);
319         ibmebus_remove_devices_by_id(drv->id_table);
320 }
321 EXPORT_SYMBOL(ibmebus_unregister_driver);
322
323 int ibmebus_request_irq(struct ibmebus_dev *dev,
324                         u32 ist, 
325                         irq_handler_t handler,
326                         unsigned long irq_flags, const char * devname,
327                         void *dev_id)
328 {
329         unsigned int irq = irq_create_mapping(NULL, ist);
330         
331         if (irq == NO_IRQ)
332                 return -EINVAL;
333         
334         return request_irq(irq, handler,
335                            irq_flags, devname, dev_id);
336 }
337 EXPORT_SYMBOL(ibmebus_request_irq);
338
339 void ibmebus_free_irq(struct ibmebus_dev *dev, u32 ist, void *dev_id)
340 {
341         unsigned int irq = irq_find_mapping(NULL, ist);
342         
343         free_irq(irq, dev_id);
344 }
345 EXPORT_SYMBOL(ibmebus_free_irq);
346
347 static int ibmebus_bus_match(struct device *dev, struct device_driver *drv)
348 {       
349         const struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
350         struct ibmebus_driver *ebus_drv    = to_ibmebus_driver(drv);
351         const struct of_device_id *ids     = ebus_drv->id_table;
352         const struct of_device_id *found_id;
353         
354         if (!ids)
355                 return 0;
356         
357         found_id = of_match_device(ids, &ebus_dev->ofdev);
358         if (found_id)
359                 return 1;
360         
361         return 0;
362 }
363
364 struct bus_type ibmebus_bus_type = {
365         .name = "ibmebus",
366         .match = ibmebus_bus_match,
367 };
368 EXPORT_SYMBOL(ibmebus_bus_type);
369
370 static int __init ibmebus_bus_init(void)
371 {
372         int err;
373         
374         printk(KERN_INFO "IBM eBus Device Driver\n");
375         
376         err = bus_register(&ibmebus_bus_type);
377         if (err) {
378                 printk(KERN_ERR ":%s: failed to register IBM eBus.\n",
379                        __FUNCTION__);
380                 return err;
381         }
382         
383         err = device_register(&ibmebus_bus_device.ofdev.dev);
384         if (err) {
385                 printk(KERN_WARNING "%s: device_register returned %i\n", 
386                        __FUNCTION__, err);
387                 bus_unregister(&ibmebus_bus_type);
388
389                 return err;
390         }
391         
392         return 0;
393 }
394 __initcall(ibmebus_bus_init);