vserver 1.9.3
[linux-2.6.git] / arch / ppc64 / kernel / vio.c
index 817f315..48c4b0a 100644 (file)
 #include <asm/vio.h>
 #include <asm/hvcall.h>
 #include <asm/iSeries/vio.h>
+#include <asm/iSeries/HvTypes.h>
 #include <asm/iSeries/HvCallXm.h>
+#include <asm/iSeries/HvLpConfig.h>
 
 #define DBGENTER() pr_debug("%s entered\n", __FUNCTION__)
 
 extern struct subsystem devices_subsys; /* needed for vio_find_name() */
 
-struct iommu_table *vio_build_iommu_table(struct vio_dev *dev);
+static const struct vio_device_id *vio_match_device(
+               const struct vio_device_id *, const struct vio_dev *);
 
 #ifdef CONFIG_PPC_PSERIES
+static struct iommu_table *vio_build_iommu_table(struct vio_dev *);
 static int vio_num_address_cells;
 #endif
 static struct vio_dev *vio_bus_device; /* fake "parent" device */
 
 #ifdef CONFIG_PPC_ISERIES
+static struct vio_dev *__init vio_register_device_iseries(char *type,
+               uint32_t unit_num);
+
 static struct iommu_table veth_iommu_table;
 static struct iommu_table vio_iommu_table;
 
-static struct vio_dev _veth_dev = {
-       .iommu_table = &veth_iommu_table,
-       .dev.bus = &vio_bus_type
-};
 static struct vio_dev _vio_dev  = {
        .iommu_table = &vio_iommu_table,
        .dev.bus = &vio_bus_type
 };
-
-struct vio_dev *iSeries_veth_dev = &_veth_dev;
 struct device *iSeries_vio_dev = &_vio_dev.dev;
-
-EXPORT_SYMBOL(iSeries_veth_dev);
 EXPORT_SYMBOL(iSeries_vio_dev);
+
+#define device_is_compatible(a, b)     1
+
 #endif
 
 /* convert from struct device to struct vio_dev and pass to driver.
@@ -136,19 +138,17 @@ EXPORT_SYMBOL(vio_unregister_driver);
  * system is in its list of supported devices. Returns the matching
  * vio_device_id structure or NULL if there is no match.
  */
-const struct vio_device_id * vio_match_device(const struct vio_device_id *ids,
+static const struct vio_device_id * vio_match_device(const struct vio_device_id *ids,
        const struct vio_dev *dev)
 {
        DBGENTER();
 
-#ifdef CONFIG_PPC_PSERIES
        while (ids->type) {
-               if ((strncmp(dev->archdata->type, ids->type, strlen(ids->type)) == 0) &&
-                       device_is_compatible((struct device_node*)dev->archdata, ids->compat))
+               if ((strncmp(dev->type, ids->type, strlen(ids->type)) == 0) &&
+                       device_is_compatible(dev->dev.platform_data, ids->compat))
                        return ids;
                ids++;
        }
-#endif
        return NULL;
 }
 
@@ -194,14 +194,63 @@ void __init iommu_vio_init(void)
 }
 #endif
 
+#ifdef CONFIG_PPC_PSERIES
+static void probe_bus_pseries(void)
+{
+       struct device_node *node_vroot, *of_node;
+
+       node_vroot = find_devices("vdevice");
+       if ((node_vroot == NULL) || (node_vroot->child == NULL))
+               /* this machine doesn't do virtual IO, and that's ok */
+               return;
+
+       vio_num_address_cells = prom_n_addr_cells(node_vroot->child);
+
+       /*
+        * Create struct vio_devices for each virtual device in the device tree.
+        * Drivers will associate with them later.
+        */
+       for (of_node = node_vroot->child; of_node != NULL;
+                       of_node = of_node->sibling) {
+               printk(KERN_DEBUG "%s: processing %p\n", __FUNCTION__, of_node);
+               vio_register_device_node(of_node);
+       }
+}
+#endif
+
+#ifdef CONFIG_PPC_ISERIES
+static void probe_bus_iseries(void)
+{
+       HvLpIndexMap vlan_map = HvLpConfig_getVirtualLanIndexMap();
+       struct vio_dev *viodev;
+       int i;
+
+       /* there is only one of each of these */
+       vio_register_device_iseries("viocons", 0);
+       vio_register_device_iseries("vscsi", 0);
+
+       vlan_map = HvLpConfig_getVirtualLanIndexMap();
+       for (i = 0; i < HVMAXARCHITECTEDVIRTUALLANS; i++) {
+               if ((vlan_map & (0x8000 >> i)) == 0)
+                       continue;
+               viodev = vio_register_device_iseries("vlan", i);
+               /* veth is special and has it own iommu_table */
+               viodev->iommu_table = &veth_iommu_table;
+       }
+       for (i = 0; i < HVMAXARCHITECTEDVIRTUALDISKS; i++)
+               vio_register_device_iseries("viodasd", i);
+       for (i = 0; i < HVMAXARCHITECTEDVIRTUALCDROMS; i++)
+               vio_register_device_iseries("viocd", i);
+       for (i = 0; i < HVMAXARCHITECTEDVIRTUALTAPES; i++)
+               vio_register_device_iseries("viotape", i);
+}
+#endif
+
 /**
  * vio_bus_init: - Initialize the virtual IO bus
  */
 static int __init vio_bus_init(void)
 {
-#ifdef CONFIG_PPC_PSERIES
-       struct device_node *node_vroot, *of_node;
-#endif
        int err;
 
        err = bus_register(&vio_bus_type);
@@ -227,25 +276,10 @@ static int __init vio_bus_init(void)
        }
 
 #ifdef CONFIG_PPC_PSERIES
-       node_vroot = find_devices("vdevice");
-       if ((node_vroot == NULL) || (node_vroot->child == NULL)) {
-               /* this machine doesn't do virtual IO, and that's ok */
-               return 0;
-       }
-
-       vio_num_address_cells = prom_n_addr_cells(node_vroot->child);
-
-       /*
-        * Create struct vio_devices for each virtual device in the device tree.
-        * Drivers will associate with them later.
-        */
-       for (of_node = node_vroot->child;
-                       of_node != NULL;
-                       of_node = of_node->sibling) {
-               printk(KERN_DEBUG "%s: processing %p\n", __FUNCTION__, of_node);
-
-               vio_register_device(of_node);
-       }
+       probe_bus_pseries();
+#endif
+#ifdef CONFIG_PPC_ISERIES
+       probe_bus_iseries();
 #endif
 
        return 0;
@@ -253,39 +287,71 @@ static int __init vio_bus_init(void)
 
 __initcall(vio_bus_init);
 
-
-#ifdef CONFIG_PPC_PSERIES
 /* vio_dev refcount hit 0 */
 static void __devinit vio_dev_release(struct device *dev)
 {
-       struct vio_dev *viodev = to_vio_dev(dev);
-
        DBGENTER();
 
+#ifdef CONFIG_PPC_PSERIES
        /* XXX free TCE table */
-       of_node_put(viodev->archdata);
-       kfree(viodev);
+       of_node_put(dev->platform_data);
+#endif
+       kfree(to_vio_dev(dev));
 }
 
-static ssize_t viodev_show_name(struct device *dev, char *buf)
+#ifdef CONFIG_PPC_PSERIES
+static ssize_t viodev_show_devspec(struct device *dev, char *buf)
 {
-       struct vio_dev *viodev = to_vio_dev(dev);
-       struct device_node *of_node = viodev->archdata;
+       struct device_node *of_node = dev->platform_data;
 
-       return sprintf(buf, "%s\n", of_node->name);
+       return sprintf(buf, "%s\n", of_node->full_name);
+}
+DEVICE_ATTR(devspec, S_IRUSR | S_IRGRP | S_IROTH, viodev_show_devspec, NULL);
+#endif
+
+static ssize_t viodev_show_name(struct device *dev, char *buf)
+{
+       return sprintf(buf, "%s\n", to_vio_dev(dev)->name);
 }
 DEVICE_ATTR(name, S_IRUSR | S_IRGRP | S_IROTH, viodev_show_name, NULL);
 
+static struct vio_dev * __devinit vio_register_device_common(
+               struct vio_dev *viodev, char *name, char *type,
+               uint32_t unit_address, struct iommu_table *iommu_table)
+{
+       DBGENTER();
+
+       viodev->name = name;
+       viodev->type = type;
+       viodev->unit_address = unit_address;
+       viodev->iommu_table = iommu_table;
+       /* init generic 'struct device' fields: */
+       viodev->dev.parent = &vio_bus_device->dev;
+       viodev->dev.bus = &vio_bus_type;
+       viodev->dev.release = vio_dev_release;
+
+       /* register with generic device framework */
+       if (device_register(&viodev->dev)) {
+               printk(KERN_ERR "%s: failed to register device %s\n",
+                               __FUNCTION__, viodev->dev.bus_id);
+               return NULL;
+       }
+       device_create_file(&viodev->dev, &dev_attr_name);
+
+       return viodev;
+}
+
+#ifdef CONFIG_PPC_PSERIES
 /**
- * vio_register_device: - Register a new vio device.
+ * vio_register_device_node: - Register a new vio device.
  * @of_node:   The OF node for this device.
  *
  * Creates and initializes a vio_dev structure from the data in
- * of_node (archdata) and adds it to the list of virtual devices.
+ * of_node (dev.platform_data) and adds it to the list of virtual devices.
  * Returns a pointer to the created vio_dev or NULL if node has
  * NULL device_type or compatible fields.
  */
-struct vio_dev * __devinit vio_register_device(struct device_node *of_node)
+struct vio_dev * __devinit vio_register_device_node(struct device_node *of_node)
 {
        struct vio_dev *viodev;
        unsigned int *unit_address;
@@ -315,12 +381,10 @@ struct vio_dev * __devinit vio_register_device(struct device_node *of_node)
        }
        memset(viodev, 0, sizeof(struct vio_dev));
 
-       viodev->archdata = (void *)of_node_get(of_node);
-       viodev->unit_address = *unit_address;
-       viodev->iommu_table = vio_build_iommu_table(viodev);
+       viodev->dev.platform_data = of_node_get(of_node);
 
        viodev->irq = NO_IRQ;
-       irq_p = (unsigned int *)get_property(of_node, "interrupts", 0);
+       irq_p = (unsigned int *)get_property(of_node, "interrupts", NULL);
        if (irq_p) {
                int virq = virt_irq_create_mapping(*irq_p);
                if (virq == NO_IRQ) {
@@ -330,33 +394,60 @@ struct vio_dev * __devinit vio_register_device(struct device_node *of_node)
                        viodev->irq = irq_offset_up(virq);
        }
 
-       /* init generic 'struct device' fields: */
-       viodev->dev.parent = &vio_bus_device->dev;
-       viodev->dev.bus = &vio_bus_type;
-       snprintf(viodev->dev.bus_id, BUS_ID_SIZE, "%x", viodev->unit_address);
-       viodev->dev.release = vio_dev_release;
+       snprintf(viodev->dev.bus_id, BUS_ID_SIZE, "%x", *unit_address);
 
        /* register with generic device framework */
-       if (device_register(&viodev->dev)) {
-               printk(KERN_ERR "%s: failed to register device %s\n", __FUNCTION__,
-                       viodev->dev.bus_id);
+       if (vio_register_device_common(viodev, of_node->name, of_node->type,
+                               *unit_address, vio_build_iommu_table(viodev))
+                       == NULL) {
                /* XXX free TCE table */
                kfree(viodev);
                return NULL;
        }
-       device_create_file(&viodev->dev, &dev_attr_name);
+       device_create_file(&viodev->dev, &dev_attr_devspec);
 
        return viodev;
 }
-EXPORT_SYMBOL(vio_register_device);
+EXPORT_SYMBOL(vio_register_device_node);
+#endif
+
+#ifdef CONFIG_PPC_ISERIES
+/**
+ * vio_register_device: - Register a new vio device.
+ * @voidev:    The device to register.
+ */
+static struct vio_dev *__init vio_register_device_iseries(char *type,
+               uint32_t unit_num)
+{
+       struct vio_dev *viodev;
+
+       DBGENTER();
+
+       /* allocate a vio_dev for this node */
+       viodev = kmalloc(sizeof(struct vio_dev), GFP_KERNEL);
+       if (!viodev)
+               return NULL;
+       memset(viodev, 0, sizeof(struct vio_dev));
+
+       snprintf(viodev->dev.bus_id, BUS_ID_SIZE, "%s%d", type, unit_num);
+
+       return vio_register_device_common(viodev, viodev->dev.bus_id, type,
+                       unit_num, &vio_iommu_table);
+}
+#endif
 
 void __devinit vio_unregister_device(struct vio_dev *viodev)
 {
        DBGENTER();
+#ifdef CONFIG_PPC_PSERIES
+       device_remove_file(&viodev->dev, &dev_attr_devspec);
+#endif
+       device_remove_file(&viodev->dev, &dev_attr_name);
        device_unregister(&viodev->dev);
 }
 EXPORT_SYMBOL(vio_unregister_device);
 
+#ifdef CONFIG_PPC_PSERIES
 /**
  * vio_get_attribute: - get attribute for virtual device
  * @vdev:      The vio device to get property.
@@ -368,7 +459,7 @@ EXPORT_SYMBOL(vio_unregister_device);
 */
 const void * vio_get_attribute(struct vio_dev *vdev, void* which, int* length)
 {
-       return get_property((struct device_node *)vdev->archdata, (char*)which, length);
+       return get_property(vdev->dev.platform_data, (char*)which, length);
 }
 EXPORT_SYMBOL(vio_get_attribute);
 
@@ -415,7 +506,7 @@ EXPORT_SYMBOL(vio_find_node);
  * Returns a pointer to the built tce tree, or NULL if it can't
  * find property.
 */
-struct iommu_table * vio_build_iommu_table(struct vio_dev *dev)
+static struct iommu_table * vio_build_iommu_table(struct vio_dev *dev)
 {
        unsigned int *dma_window;
        struct iommu_table *newTceTable;
@@ -423,7 +514,7 @@ struct iommu_table * vio_build_iommu_table(struct vio_dev *dev)
        unsigned long size;
        int dma_window_property_size;
 
-       dma_window = (unsigned int *) get_property((struct device_node *)dev->archdata, "ibm,my-dma-window", &dma_window_property_size);
+       dma_window = (unsigned int *) get_property(dev->dev.platform_data, "ibm,my-dma-window", &dma_window_property_size);
        if(!dma_window) {
                return NULL;
        }