[POWERPC] 32-bit early_init() should zero from __bss_start to __bss_stop only
[deliverable/linux.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
f8485350 217 dev = kzalloc(sizeof(struct ibmebus_dev), GFP_KERNEL);
d7a30103
HS
218 if (!dev) {
219 return NULL;
220 }
d7a30103
HS
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
238static 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
255static 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
265static 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
273static 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
281static 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
298int 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}
314EXPORT_SYMBOL(ibmebus_register_driver);
315
316void ibmebus_unregister_driver(struct ibmebus_driver *drv)
317{
318 driver_unregister(&drv->driver);
319 ibmebus_remove_devices_by_id(drv->id_table);
320}
321EXPORT_SYMBOL(ibmebus_unregister_driver);
322
323int ibmebus_request_irq(struct ibmebus_dev *dev,
324 u32 ist,
40220c1a 325 irq_handler_t handler,
d7a30103
HS
326 unsigned long irq_flags, const char * devname,
327 void *dev_id)
328{
6e99e458 329 unsigned int irq = irq_create_mapping(NULL, ist);
d7a30103
HS
330
331 if (irq == NO_IRQ)
332 return -EINVAL;
333
d7a30103
HS
334 return request_irq(irq, handler,
335 irq_flags, devname, dev_id);
336}
337EXPORT_SYMBOL(ibmebus_request_irq);
338
339void ibmebus_free_irq(struct ibmebus_dev *dev, u32 ist, void *dev_id)
340{
0ebfff14 341 unsigned int irq = irq_find_mapping(NULL, ist);
d7a30103 342
d7a30103 343 free_irq(irq, dev_id);
d7a30103
HS
344}
345EXPORT_SYMBOL(ibmebus_free_irq);
346
347static 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
364struct bus_type ibmebus_bus_type = {
365 .name = "ibmebus",
366 .match = ibmebus_bus_match,
367};
368EXPORT_SYMBOL(ibmebus_bus_type);
369
370static 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);
This page took 0.176148 seconds and 5 git commands to generate.