[POWERPC] Refactor 64 bits DMA operations
[linux-2.6-block.git] / arch / powerpc / kernel / ibmebus.c
CommitLineData
d7a30103
HS
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
46static 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
52static 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
65static 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
72static 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
80static 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
88static 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
103static void ibmebus_unmap_sg(struct device *dev,
104 struct scatterlist *sg,
105 int nents, enum dma_data_direction direction)
106{
107 return;
108}
109
110static int ibmebus_dma_supported(struct device *dev, u64 mask)
111{
112 return 1;
113}
114
12d04eef 115static struct dma_mapping_ops ibmebus_dma_ops = {
d7a30103
HS
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
125static 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
143static 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
155static 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
161static 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}
166static DEVICE_ATTR(name, S_IRUSR | S_IRGRP | S_IROTH, ibmebusdev_show_name,
167 NULL);
168
169static struct ibmebus_dev* __devinit ibmebus_register_device_common(
a7f67bdf 170 struct ibmebus_dev *dev, const char *name)
d7a30103
HS
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
12d04eef
BH
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
d7a30103
HS
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
197static struct ibmebus_dev* __devinit ibmebus_register_device_node(
198 struct device_node *dn)
199{
200 struct ibmebus_dev *dev;
a7f67bdf 201 const char *loc_code;
d7a30103
HS
202 int length;
203
a7f67bdf 204 loc_code = get_property(dn, "ibm,loc-code", NULL);
d7a30103
HS
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 = kmalloc(sizeof(struct ibmebus_dev), GFP_KERNEL);
218 if (!dev) {
219 return NULL;
220 }
221 memset(dev, 0, sizeof(struct ibmebus_dev));
222
223 dev->ofdev.node = of_node_get(dn);
224
225 length = strlen(loc_code);
226 memcpy(dev->ofdev.dev.bus_id, loc_code
227 + (length - min(length, BUS_ID_SIZE - 1)),
228 min(length, BUS_ID_SIZE - 1));
229
230 /* Register with generic device framework. */
231 if (ibmebus_register_device_common(dev, dn->name) == NULL) {
232 kfree(dev);
233 return NULL;
234 }
235
236 return dev;
237}
238
239static void ibmebus_probe_of_nodes(char* name)
240{
241 struct device_node *dn = NULL;
242
243 while ((dn = of_find_node_by_name(dn, name))) {
244 if (ibmebus_register_device_node(dn) == NULL) {
245 of_node_put(dn);
246
247 return;
248 }
249 }
250
251 of_node_put(dn);
252
253 return;
254}
255
256static void ibmebus_add_devices_by_id(struct of_device_id *idt)
257{
258 while (strlen(idt->name) > 0) {
259 ibmebus_probe_of_nodes(idt->name);
260 idt++;
261 }
262
263 return;
264}
265
266static int ibmebus_match_helper(struct device *dev, void *data)
267{
268 if (strcmp((char*)data, to_ibmebus_dev(dev)->name) == 0)
269 return 1;
270
271 return 0;
272}
273
274static int ibmebus_unregister_device(struct device *dev)
275{
276 device_remove_file(dev, &dev_attr_name);
277 of_device_unregister(to_of_device(dev));
278
279 return 0;
280}
281
282static void ibmebus_remove_devices_by_id(struct of_device_id *idt)
283{
284 struct device *dev;
285
286 while (strlen(idt->name) > 0) {
287 while ((dev = bus_find_device(&ibmebus_bus_type, NULL,
288 (void*)idt->name,
289 ibmebus_match_helper))) {
290 ibmebus_unregister_device(dev);
291 }
292 idt++;
293
294 }
295
296 return;
297}
298
299int ibmebus_register_driver(struct ibmebus_driver *drv)
300{
301 int err = 0;
302
303 drv->driver.name = drv->name;
304 drv->driver.bus = &ibmebus_bus_type;
305 drv->driver.probe = ibmebus_bus_probe;
306 drv->driver.remove = ibmebus_bus_remove;
307
308 if ((err = driver_register(&drv->driver) != 0))
309 return err;
310
311 ibmebus_add_devices_by_id(drv->id_table);
312
313 return 0;
314}
315EXPORT_SYMBOL(ibmebus_register_driver);
316
317void ibmebus_unregister_driver(struct ibmebus_driver *drv)
318{
319 driver_unregister(&drv->driver);
320 ibmebus_remove_devices_by_id(drv->id_table);
321}
322EXPORT_SYMBOL(ibmebus_unregister_driver);
323
324int ibmebus_request_irq(struct ibmebus_dev *dev,
325 u32 ist,
40220c1a 326 irq_handler_t handler,
d7a30103
HS
327 unsigned long irq_flags, const char * devname,
328 void *dev_id)
329{
6e99e458 330 unsigned int irq = irq_create_mapping(NULL, ist);
d7a30103
HS
331
332 if (irq == NO_IRQ)
333 return -EINVAL;
334
d7a30103
HS
335 return request_irq(irq, handler,
336 irq_flags, devname, dev_id);
337}
338EXPORT_SYMBOL(ibmebus_request_irq);
339
340void ibmebus_free_irq(struct ibmebus_dev *dev, u32 ist, void *dev_id)
341{
0ebfff14 342 unsigned int irq = irq_find_mapping(NULL, ist);
d7a30103 343
d7a30103 344 free_irq(irq, dev_id);
d7a30103
HS
345}
346EXPORT_SYMBOL(ibmebus_free_irq);
347
348static int ibmebus_bus_match(struct device *dev, struct device_driver *drv)
349{
350 const struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
351 struct ibmebus_driver *ebus_drv = to_ibmebus_driver(drv);
352 const struct of_device_id *ids = ebus_drv->id_table;
353 const struct of_device_id *found_id;
354
355 if (!ids)
356 return 0;
357
358 found_id = of_match_device(ids, &ebus_dev->ofdev);
359 if (found_id)
360 return 1;
361
362 return 0;
363}
364
365struct bus_type ibmebus_bus_type = {
366 .name = "ibmebus",
367 .match = ibmebus_bus_match,
368};
369EXPORT_SYMBOL(ibmebus_bus_type);
370
371static int __init ibmebus_bus_init(void)
372{
373 int err;
374
375 printk(KERN_INFO "IBM eBus Device Driver\n");
376
377 err = bus_register(&ibmebus_bus_type);
378 if (err) {
379 printk(KERN_ERR ":%s: failed to register IBM eBus.\n",
380 __FUNCTION__);
381 return err;
382 }
383
384 err = device_register(&ibmebus_bus_device.ofdev.dev);
385 if (err) {
386 printk(KERN_WARNING "%s: device_register returned %i\n",
387 __FUNCTION__, err);
388 bus_unregister(&ibmebus_bus_type);
389
390 return err;
391 }
392
393 return 0;
394}
395__initcall(ibmebus_bus_init);