[PATCH] Change cpu_up and co from __devinit to __cpuinit
[linux-2.6] / arch / powerpc / kernel / vio.c
1 /*
2  * IBM PowerPC Virtual I/O Infrastructure Support.
3  *
4  *    Copyright (c) 2003-2005 IBM Corp.
5  *     Dave Engebretsen engebret@us.ibm.com
6  *     Santiago Leon santil@us.ibm.com
7  *     Hollis Blanchard <hollisb@us.ibm.com>
8  *     Stephen Rothwell
9  *
10  *      This program is free software; you can redistribute it and/or
11  *      modify it under the terms of the GNU General Public License
12  *      as published by the Free Software Foundation; either version
13  *      2 of the License, or (at your option) any later version.
14  */
15
16 #include <linux/types.h>
17 #include <linux/device.h>
18 #include <linux/init.h>
19 #include <linux/console.h>
20 #include <linux/module.h>
21 #include <linux/mm.h>
22 #include <linux/dma-mapping.h>
23 #include <linux/kobject.h>
24
25 #include <asm/iommu.h>
26 #include <asm/dma.h>
27 #include <asm/vio.h>
28 #include <asm/prom.h>
29 #include <asm/firmware.h>
30 #include <asm/tce.h>
31 #include <asm/abs_addr.h>
32 #include <asm/page.h>
33 #include <asm/hvcall.h>
34 #include <asm/iseries/vio.h>
35 #include <asm/iseries/hv_types.h>
36 #include <asm/iseries/hv_lp_config.h>
37 #include <asm/iseries/hv_call_xm.h>
38 #include <asm/iseries/iommu.h>
39
40 extern struct subsystem devices_subsys; /* needed for vio_find_name() */
41
42 static struct vio_dev vio_bus_device  = { /* fake "parent" device */
43         .name = vio_bus_device.dev.bus_id,
44         .type = "",
45         .dev.bus_id = "vio",
46         .dev.bus = &vio_bus_type,
47 };
48
49 #ifdef CONFIG_PPC_ISERIES
50 struct device *iSeries_vio_dev = &vio_bus_device.dev;
51 EXPORT_SYMBOL(iSeries_vio_dev);
52
53 static struct iommu_table veth_iommu_table;
54 static struct iommu_table vio_iommu_table;
55
56 static void __init iommu_vio_init(void)
57 {
58         iommu_table_getparms_iSeries(255, 0, 0xff, &veth_iommu_table);
59         veth_iommu_table.it_size /= 2;
60         vio_iommu_table = veth_iommu_table;
61         vio_iommu_table.it_offset += veth_iommu_table.it_size;
62
63         if (!iommu_init_table(&veth_iommu_table, -1))
64                 printk("Virtual Bus VETH TCE table failed.\n");
65         if (!iommu_init_table(&vio_iommu_table, -1))
66                 printk("Virtual Bus VIO TCE table failed.\n");
67 }
68 #endif
69
70 static struct iommu_table *vio_build_iommu_table(struct vio_dev *dev)
71 {
72 #ifdef CONFIG_PPC_ISERIES
73         if (firmware_has_feature(FW_FEATURE_ISERIES)) {
74                 if (strcmp(dev->type, "network") == 0)
75                         return &veth_iommu_table;
76                 return &vio_iommu_table;
77         } else
78 #endif
79         {
80                 const unsigned char *dma_window;
81                 struct iommu_table *tbl;
82                 unsigned long offset, size;
83
84                 dma_window = get_property(dev->dev.archdata.of_node,
85                                           "ibm,my-dma-window", NULL);
86                 if (!dma_window)
87                         return NULL;
88
89                 tbl = kmalloc(sizeof(*tbl), GFP_KERNEL);
90
91                 of_parse_dma_window(dev->dev.archdata.of_node, dma_window,
92                                     &tbl->it_index, &offset, &size);
93
94                 /* TCE table size - measured in tce entries */
95                 tbl->it_size = size >> IOMMU_PAGE_SHIFT;
96                 /* offset for VIO should always be 0 */
97                 tbl->it_offset = offset >> IOMMU_PAGE_SHIFT;
98                 tbl->it_busno = 0;
99                 tbl->it_type = TCE_VB;
100
101                 return iommu_init_table(tbl, -1);
102         }
103 }
104
105 /**
106  * vio_match_device: - Tell if a VIO device has a matching
107  *                      VIO device id structure.
108  * @ids:        array of VIO device id structures to search in
109  * @dev:        the VIO device structure to match against
110  *
111  * Used by a driver to check whether a VIO device present in the
112  * system is in its list of supported devices. Returns the matching
113  * vio_device_id structure or NULL if there is no match.
114  */
115 static const struct vio_device_id *vio_match_device(
116                 const struct vio_device_id *ids, const struct vio_dev *dev)
117 {
118         while (ids->type[0] != '\0') {
119                 if ((strncmp(dev->type, ids->type, strlen(ids->type)) == 0) &&
120                     device_is_compatible(dev->dev.archdata.of_node,
121                                          ids->compat))
122                         return ids;
123                 ids++;
124         }
125         return NULL;
126 }
127
128 /*
129  * Convert from struct device to struct vio_dev and pass to driver.
130  * dev->driver has already been set by generic code because vio_bus_match
131  * succeeded.
132  */
133 static int vio_bus_probe(struct device *dev)
134 {
135         struct vio_dev *viodev = to_vio_dev(dev);
136         struct vio_driver *viodrv = to_vio_driver(dev->driver);
137         const struct vio_device_id *id;
138         int error = -ENODEV;
139
140         if (!viodrv->probe)
141                 return error;
142
143         id = vio_match_device(viodrv->id_table, viodev);
144         if (id)
145                 error = viodrv->probe(viodev, id);
146
147         return error;
148 }
149
150 /* convert from struct device to struct vio_dev and pass to driver. */
151 static int vio_bus_remove(struct device *dev)
152 {
153         struct vio_dev *viodev = to_vio_dev(dev);
154         struct vio_driver *viodrv = to_vio_driver(dev->driver);
155
156         if (viodrv->remove)
157                 return viodrv->remove(viodev);
158
159         /* driver can't remove */
160         return 1;
161 }
162
163 /* convert from struct device to struct vio_dev and pass to driver. */
164 static void vio_bus_shutdown(struct device *dev)
165 {
166         struct vio_dev *viodev = to_vio_dev(dev);
167         struct vio_driver *viodrv = to_vio_driver(dev->driver);
168
169         if (dev->driver && viodrv->shutdown)
170                 viodrv->shutdown(viodev);
171 }
172
173 /**
174  * vio_register_driver: - Register a new vio driver
175  * @drv:        The vio_driver structure to be registered.
176  */
177 int vio_register_driver(struct vio_driver *viodrv)
178 {
179         printk(KERN_DEBUG "%s: driver %s registering\n", __FUNCTION__,
180                 viodrv->driver.name);
181
182         /* fill in 'struct driver' fields */
183         viodrv->driver.bus = &vio_bus_type;
184
185         return driver_register(&viodrv->driver);
186 }
187 EXPORT_SYMBOL(vio_register_driver);
188
189 /**
190  * vio_unregister_driver - Remove registration of vio driver.
191  * @driver:     The vio_driver struct to be removed form registration
192  */
193 void vio_unregister_driver(struct vio_driver *viodrv)
194 {
195         driver_unregister(&viodrv->driver);
196 }
197 EXPORT_SYMBOL(vio_unregister_driver);
198
199 /* vio_dev refcount hit 0 */
200 static void __devinit vio_dev_release(struct device *dev)
201 {
202         if (dev->archdata.of_node) {
203                 /* XXX should free TCE table */
204                 of_node_put(dev->archdata.of_node);
205         }
206         kfree(to_vio_dev(dev));
207 }
208
209 /**
210  * vio_register_device_node: - Register a new vio device.
211  * @of_node:    The OF node for this device.
212  *
213  * Creates and initializes a vio_dev structure from the data in
214  * of_node and adds it to the list of virtual devices.
215  * Returns a pointer to the created vio_dev or NULL if node has
216  * NULL device_type or compatible fields.
217  */
218 struct vio_dev * __devinit vio_register_device_node(struct device_node *of_node)
219 {
220         struct vio_dev *viodev;
221         const unsigned int *unit_address;
222
223         /* we need the 'device_type' property, in order to match with drivers */
224         if (of_node->type == NULL) {
225                 printk(KERN_WARNING "%s: node %s missing 'device_type'\n",
226                                 __FUNCTION__,
227                                 of_node->name ? of_node->name : "<unknown>");
228                 return NULL;
229         }
230
231         unit_address = get_property(of_node, "reg", NULL);
232         if (unit_address == NULL) {
233                 printk(KERN_WARNING "%s: node %s missing 'reg'\n",
234                                 __FUNCTION__,
235                                 of_node->name ? of_node->name : "<unknown>");
236                 return NULL;
237         }
238
239         /* allocate a vio_dev for this node */
240         viodev = kzalloc(sizeof(struct vio_dev), GFP_KERNEL);
241         if (viodev == NULL)
242                 return NULL;
243
244         viodev->irq = irq_of_parse_and_map(of_node, 0);
245
246         snprintf(viodev->dev.bus_id, BUS_ID_SIZE, "%x", *unit_address);
247         viodev->name = of_node->name;
248         viodev->type = of_node->type;
249         viodev->unit_address = *unit_address;
250         if (firmware_has_feature(FW_FEATURE_ISERIES)) {
251                 unit_address = get_property(of_node,
252                                 "linux,unit_address", NULL);
253                 if (unit_address != NULL)
254                         viodev->unit_address = *unit_address;
255         }
256         viodev->dev.archdata.of_node = of_node_get(of_node);
257         viodev->dev.archdata.dma_ops = &dma_iommu_ops;
258         viodev->dev.archdata.dma_data = vio_build_iommu_table(viodev);
259         viodev->dev.archdata.numa_node = of_node_to_nid(of_node);
260
261         /* init generic 'struct device' fields: */
262         viodev->dev.parent = &vio_bus_device.dev;
263         viodev->dev.bus = &vio_bus_type;
264         viodev->dev.release = vio_dev_release;
265
266         /* register with generic device framework */
267         if (device_register(&viodev->dev)) {
268                 printk(KERN_ERR "%s: failed to register device %s\n",
269                                 __FUNCTION__, viodev->dev.bus_id);
270                 /* XXX free TCE table */
271                 kfree(viodev);
272                 return NULL;
273         }
274
275         return viodev;
276 }
277 EXPORT_SYMBOL(vio_register_device_node);
278
279 /**
280  * vio_bus_init: - Initialize the virtual IO bus
281  */
282 static int __init vio_bus_init(void)
283 {
284         int err;
285         struct device_node *node_vroot;
286
287 #ifdef CONFIG_PPC_ISERIES
288         if (firmware_has_feature(FW_FEATURE_ISERIES)) {
289                 iommu_vio_init();
290                 vio_bus_device.dev.archdata.dma_ops = &dma_iommu_ops;
291                 vio_bus_device.dev.archdata.dma_data = &vio_iommu_table;
292                 iSeries_vio_dev = &vio_bus_device.dev;
293         }
294 #endif /* CONFIG_PPC_ISERIES */
295
296         err = bus_register(&vio_bus_type);
297         if (err) {
298                 printk(KERN_ERR "failed to register VIO bus\n");
299                 return err;
300         }
301
302         /*
303          * The fake parent of all vio devices, just to give us
304          * a nice directory
305          */
306         err = device_register(&vio_bus_device.dev);
307         if (err) {
308                 printk(KERN_WARNING "%s: device_register returned %i\n",
309                                 __FUNCTION__, err);
310                 return err;
311         }
312
313         node_vroot = find_devices("vdevice");
314         if (node_vroot) {
315                 struct device_node *of_node;
316
317                 /*
318                  * Create struct vio_devices for each virtual device in
319                  * the device tree. Drivers will associate with them later.
320                  */
321                 for (of_node = node_vroot->child; of_node != NULL;
322                                 of_node = of_node->sibling) {
323                         printk(KERN_DEBUG "%s: processing %p\n",
324                                         __FUNCTION__, of_node);
325                         vio_register_device_node(of_node);
326                 }
327         }
328
329         return 0;
330 }
331 __initcall(vio_bus_init);
332
333 static ssize_t name_show(struct device *dev,
334                 struct device_attribute *attr, char *buf)
335 {
336         return sprintf(buf, "%s\n", to_vio_dev(dev)->name);
337 }
338
339 static ssize_t devspec_show(struct device *dev,
340                 struct device_attribute *attr, char *buf)
341 {
342         struct device_node *of_node = dev->archdata.of_node;
343
344         return sprintf(buf, "%s\n", of_node ? of_node->full_name : "none");
345 }
346
347 static struct device_attribute vio_dev_attrs[] = {
348         __ATTR_RO(name),
349         __ATTR_RO(devspec),
350         __ATTR_NULL
351 };
352
353 void __devinit vio_unregister_device(struct vio_dev *viodev)
354 {
355         device_unregister(&viodev->dev);
356 }
357 EXPORT_SYMBOL(vio_unregister_device);
358
359 static int vio_bus_match(struct device *dev, struct device_driver *drv)
360 {
361         const struct vio_dev *vio_dev = to_vio_dev(dev);
362         struct vio_driver *vio_drv = to_vio_driver(drv);
363         const struct vio_device_id *ids = vio_drv->id_table;
364
365         return (ids != NULL) && (vio_match_device(ids, vio_dev) != NULL);
366 }
367
368 static int vio_hotplug(struct device *dev, char **envp, int num_envp,
369                         char *buffer, int buffer_size)
370 {
371         const struct vio_dev *vio_dev = to_vio_dev(dev);
372         struct device_node *dn;
373         const char *cp;
374         int length;
375
376         if (!num_envp)
377                 return -ENOMEM;
378
379         dn = dev->archdata.of_node;
380         if (!dn)
381                 return -ENODEV;
382         cp = get_property(dn, "compatible", &length);
383         if (!cp)
384                 return -ENODEV;
385
386         envp[0] = buffer;
387         length = scnprintf(buffer, buffer_size, "MODALIAS=vio:T%sS%s",
388                                 vio_dev->type, cp);
389         if ((buffer_size - length) <= 0)
390                 return -ENOMEM;
391         envp[1] = NULL;
392         return 0;
393 }
394
395 struct bus_type vio_bus_type = {
396         .name = "vio",
397         .dev_attrs = vio_dev_attrs,
398         .uevent = vio_hotplug,
399         .match = vio_bus_match,
400         .probe = vio_bus_probe,
401         .remove = vio_bus_remove,
402         .shutdown = vio_bus_shutdown,
403 };
404
405 /**
406  * vio_get_attribute: - get attribute for virtual device
407  * @vdev:       The vio device to get property.
408  * @which:      The property/attribute to be extracted.
409  * @length:     Pointer to length of returned data size (unused if NULL).
410  *
411  * Calls prom.c's get_property() to return the value of the
412  * attribute specified by @which
413 */
414 const void *vio_get_attribute(struct vio_dev *vdev, char *which, int *length)
415 {
416         return get_property(vdev->dev.archdata.of_node, which, length);
417 }
418 EXPORT_SYMBOL(vio_get_attribute);
419
420 #ifdef CONFIG_PPC_PSERIES
421 /* vio_find_name() - internal because only vio.c knows how we formatted the
422  * kobject name
423  * XXX once vio_bus_type.devices is actually used as a kset in
424  * drivers/base/bus.c, this function should be removed in favor of
425  * "device_find(kobj_name, &vio_bus_type)"
426  */
427 static struct vio_dev *vio_find_name(const char *kobj_name)
428 {
429         struct kobject *found;
430
431         found = kset_find_obj(&devices_subsys.kset, kobj_name);
432         if (!found)
433                 return NULL;
434
435         return to_vio_dev(container_of(found, struct device, kobj));
436 }
437
438 /**
439  * vio_find_node - find an already-registered vio_dev
440  * @vnode: device_node of the virtual device we're looking for
441  */
442 struct vio_dev *vio_find_node(struct device_node *vnode)
443 {
444         const uint32_t *unit_address;
445         char kobj_name[BUS_ID_SIZE];
446
447         /* construct the kobject name from the device node */
448         unit_address = get_property(vnode, "reg", NULL);
449         if (!unit_address)
450                 return NULL;
451         snprintf(kobj_name, BUS_ID_SIZE, "%x", *unit_address);
452
453         return vio_find_name(kobj_name);
454 }
455 EXPORT_SYMBOL(vio_find_node);
456
457 int vio_enable_interrupts(struct vio_dev *dev)
458 {
459         int rc = h_vio_signal(dev->unit_address, VIO_IRQ_ENABLE);
460         if (rc != H_SUCCESS)
461                 printk(KERN_ERR "vio: Error 0x%x enabling interrupts\n", rc);
462         return rc;
463 }
464 EXPORT_SYMBOL(vio_enable_interrupts);
465
466 int vio_disable_interrupts(struct vio_dev *dev)
467 {
468         int rc = h_vio_signal(dev->unit_address, VIO_IRQ_DISABLE);
469         if (rc != H_SUCCESS)
470                 printk(KERN_ERR "vio: Error 0x%x disabling interrupts\n", rc);
471         return rc;
472 }
473 EXPORT_SYMBOL(vio_disable_interrupts);
474 #endif /* CONFIG_PPC_PSERIES */