[POWERPC] Remove debug printk from vio_bus_init
[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 kset 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 = of_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                     of_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         /* XXX should free TCE table */
203         of_node_put(dev->archdata.of_node);
204         kfree(to_vio_dev(dev));
205 }
206
207 /**
208  * vio_register_device_node: - Register a new vio device.
209  * @of_node:    The OF node for this device.
210  *
211  * Creates and initializes a vio_dev structure from the data in
212  * of_node and adds it to the list of virtual devices.
213  * Returns a pointer to the created vio_dev or NULL if node has
214  * NULL device_type or compatible fields.
215  */
216 struct vio_dev * __devinit vio_register_device_node(struct device_node *of_node)
217 {
218         struct vio_dev *viodev;
219         const unsigned int *unit_address;
220
221         /* we need the 'device_type' property, in order to match with drivers */
222         if (of_node->type == NULL) {
223                 printk(KERN_WARNING "%s: node %s missing 'device_type'\n",
224                                 __FUNCTION__,
225                                 of_node->name ? of_node->name : "<unknown>");
226                 return NULL;
227         }
228
229         unit_address = of_get_property(of_node, "reg", NULL);
230         if (unit_address == NULL) {
231                 printk(KERN_WARNING "%s: node %s missing 'reg'\n",
232                                 __FUNCTION__,
233                                 of_node->name ? of_node->name : "<unknown>");
234                 return NULL;
235         }
236
237         /* allocate a vio_dev for this node */
238         viodev = kzalloc(sizeof(struct vio_dev), GFP_KERNEL);
239         if (viodev == NULL)
240                 return NULL;
241
242         viodev->irq = irq_of_parse_and_map(of_node, 0);
243
244         snprintf(viodev->dev.bus_id, BUS_ID_SIZE, "%x", *unit_address);
245         viodev->name = of_node->name;
246         viodev->type = of_node->type;
247         viodev->unit_address = *unit_address;
248         if (firmware_has_feature(FW_FEATURE_ISERIES)) {
249                 unit_address = of_get_property(of_node,
250                                 "linux,unit_address", NULL);
251                 if (unit_address != NULL)
252                         viodev->unit_address = *unit_address;
253         }
254         viodev->dev.archdata.of_node = of_node_get(of_node);
255         viodev->dev.archdata.dma_ops = &dma_iommu_ops;
256         viodev->dev.archdata.dma_data = vio_build_iommu_table(viodev);
257         viodev->dev.archdata.numa_node = of_node_to_nid(of_node);
258
259         /* init generic 'struct device' fields: */
260         viodev->dev.parent = &vio_bus_device.dev;
261         viodev->dev.bus = &vio_bus_type;
262         viodev->dev.release = vio_dev_release;
263
264         /* register with generic device framework */
265         if (device_register(&viodev->dev)) {
266                 printk(KERN_ERR "%s: failed to register device %s\n",
267                                 __FUNCTION__, viodev->dev.bus_id);
268                 /* XXX free TCE table */
269                 kfree(viodev);
270                 return NULL;
271         }
272
273         return viodev;
274 }
275 EXPORT_SYMBOL(vio_register_device_node);
276
277 /**
278  * vio_bus_init: - Initialize the virtual IO bus
279  */
280 static int __init vio_bus_init(void)
281 {
282         int err;
283         struct device_node *node_vroot;
284
285 #ifdef CONFIG_PPC_ISERIES
286         if (firmware_has_feature(FW_FEATURE_ISERIES)) {
287                 iommu_vio_init();
288                 vio_bus_device.dev.archdata.dma_ops = &dma_iommu_ops;
289                 vio_bus_device.dev.archdata.dma_data = &vio_iommu_table;
290                 iSeries_vio_dev = &vio_bus_device.dev;
291         }
292 #endif /* CONFIG_PPC_ISERIES */
293
294         err = bus_register(&vio_bus_type);
295         if (err) {
296                 printk(KERN_ERR "failed to register VIO bus\n");
297                 return err;
298         }
299
300         /*
301          * The fake parent of all vio devices, just to give us
302          * a nice directory
303          */
304         err = device_register(&vio_bus_device.dev);
305         if (err) {
306                 printk(KERN_WARNING "%s: device_register returned %i\n",
307                                 __FUNCTION__, err);
308                 return err;
309         }
310
311         node_vroot = of_find_node_by_name(NULL, "vdevice");
312         if (node_vroot) {
313                 struct device_node *of_node;
314
315                 /*
316                  * Create struct vio_devices for each virtual device in
317                  * the device tree. Drivers will associate with them later.
318                  */
319                 for (of_node = node_vroot->child; of_node != NULL;
320                                 of_node = of_node->sibling)
321                         vio_register_device_node(of_node);
322                 of_node_put(node_vroot);
323         }
324
325         return 0;
326 }
327 __initcall(vio_bus_init);
328
329 static ssize_t name_show(struct device *dev,
330                 struct device_attribute *attr, char *buf)
331 {
332         return sprintf(buf, "%s\n", to_vio_dev(dev)->name);
333 }
334
335 static ssize_t devspec_show(struct device *dev,
336                 struct device_attribute *attr, char *buf)
337 {
338         struct device_node *of_node = dev->archdata.of_node;
339
340         return sprintf(buf, "%s\n", of_node ? of_node->full_name : "none");
341 }
342
343 static struct device_attribute vio_dev_attrs[] = {
344         __ATTR_RO(name),
345         __ATTR_RO(devspec),
346         __ATTR_NULL
347 };
348
349 void __devinit vio_unregister_device(struct vio_dev *viodev)
350 {
351         device_unregister(&viodev->dev);
352 }
353 EXPORT_SYMBOL(vio_unregister_device);
354
355 static int vio_bus_match(struct device *dev, struct device_driver *drv)
356 {
357         const struct vio_dev *vio_dev = to_vio_dev(dev);
358         struct vio_driver *vio_drv = to_vio_driver(drv);
359         const struct vio_device_id *ids = vio_drv->id_table;
360
361         return (ids != NULL) && (vio_match_device(ids, vio_dev) != NULL);
362 }
363
364 static int vio_hotplug(struct device *dev, char **envp, int num_envp,
365                         char *buffer, int buffer_size)
366 {
367         const struct vio_dev *vio_dev = to_vio_dev(dev);
368         struct device_node *dn;
369         const char *cp;
370         int length;
371
372         if (!num_envp)
373                 return -ENOMEM;
374
375         dn = dev->archdata.of_node;
376         if (!dn)
377                 return -ENODEV;
378         cp = of_get_property(dn, "compatible", &length);
379         if (!cp)
380                 return -ENODEV;
381
382         envp[0] = buffer;
383         length = scnprintf(buffer, buffer_size, "MODALIAS=vio:T%sS%s",
384                                 vio_dev->type, cp);
385         if ((buffer_size - length) <= 0)
386                 return -ENOMEM;
387         envp[1] = NULL;
388         return 0;
389 }
390
391 struct bus_type vio_bus_type = {
392         .name = "vio",
393         .dev_attrs = vio_dev_attrs,
394         .uevent = vio_hotplug,
395         .match = vio_bus_match,
396         .probe = vio_bus_probe,
397         .remove = vio_bus_remove,
398         .shutdown = vio_bus_shutdown,
399 };
400
401 /**
402  * vio_get_attribute: - get attribute for virtual device
403  * @vdev:       The vio device to get property.
404  * @which:      The property/attribute to be extracted.
405  * @length:     Pointer to length of returned data size (unused if NULL).
406  *
407  * Calls prom.c's of_get_property() to return the value of the
408  * attribute specified by @which
409 */
410 const void *vio_get_attribute(struct vio_dev *vdev, char *which, int *length)
411 {
412         return of_get_property(vdev->dev.archdata.of_node, which, length);
413 }
414 EXPORT_SYMBOL(vio_get_attribute);
415
416 #ifdef CONFIG_PPC_PSERIES
417 /* vio_find_name() - internal because only vio.c knows how we formatted the
418  * kobject name
419  * XXX once vio_bus_type.devices is actually used as a kset in
420  * drivers/base/bus.c, this function should be removed in favor of
421  * "device_find(kobj_name, &vio_bus_type)"
422  */
423 static struct vio_dev *vio_find_name(const char *kobj_name)
424 {
425         struct kobject *found;
426
427         found = kset_find_obj(&devices_subsys, kobj_name);
428         if (!found)
429                 return NULL;
430
431         return to_vio_dev(container_of(found, struct device, kobj));
432 }
433
434 /**
435  * vio_find_node - find an already-registered vio_dev
436  * @vnode: device_node of the virtual device we're looking for
437  */
438 struct vio_dev *vio_find_node(struct device_node *vnode)
439 {
440         const uint32_t *unit_address;
441         char kobj_name[BUS_ID_SIZE];
442
443         /* construct the kobject name from the device node */
444         unit_address = of_get_property(vnode, "reg", NULL);
445         if (!unit_address)
446                 return NULL;
447         snprintf(kobj_name, BUS_ID_SIZE, "%x", *unit_address);
448
449         return vio_find_name(kobj_name);
450 }
451 EXPORT_SYMBOL(vio_find_node);
452
453 int vio_enable_interrupts(struct vio_dev *dev)
454 {
455         int rc = h_vio_signal(dev->unit_address, VIO_IRQ_ENABLE);
456         if (rc != H_SUCCESS)
457                 printk(KERN_ERR "vio: Error 0x%x enabling interrupts\n", rc);
458         return rc;
459 }
460 EXPORT_SYMBOL(vio_enable_interrupts);
461
462 int vio_disable_interrupts(struct vio_dev *dev)
463 {
464         int rc = h_vio_signal(dev->unit_address, VIO_IRQ_DISABLE);
465         if (rc != H_SUCCESS)
466                 printk(KERN_ERR "vio: Error 0x%x disabling interrupts\n", rc);
467         return rc;
468 }
469 EXPORT_SYMBOL(vio_disable_interrupts);
470 #endif /* CONFIG_PPC_PSERIES */