Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / staging / i2o / bus-osm.c

diff --git a/kernel/drivers/staging/i2o/bus-osm.c b/kernel/drivers/staging/i2o/bus-osm.c
new file mode 100644 (file)
index 0000000..43e357e
--- /dev/null
+++ b/kernel/drivers/staging/i2o/bus-osm.c
@@ -0,0 +1,177 @@
+/*
+ *     Bus Adapter OSM
+ *
+ *     Copyright (C) 2005      Markus Lidel <Markus.Lidel@shadowconnect.com>
+ *
+ *     This program is free software; you can redistribute it and/or modify it
+ *     under the terms of the GNU General Public License as published by the
+ *     Free Software Foundation; either version 2 of the License, or (at your
+ *     option) any later version.
+ *
+ *     Fixes/additions:
+ *             Markus Lidel <Markus.Lidel@shadowconnect.com>
+ *                     initial version.
+ */
+
+#include <linux/module.h>
+#include "i2o.h"
+
+#define OSM_NAME       "bus-osm"
+#define OSM_VERSION    "1.317"
+#define OSM_DESCRIPTION        "I2O Bus Adapter OSM"
+
+static struct i2o_driver i2o_bus_driver;
+
+/* Bus OSM class handling definition */
+static struct i2o_class_id i2o_bus_class_id[] = {
+       {I2O_CLASS_BUS_ADAPTER},
+       {I2O_CLASS_END}
+};
+
+/**
+ *     i2o_bus_scan - Scan the bus for new devices
+ *     @dev: I2O device of the bus, which should be scanned
+ *
+ *     Scans the bus dev for new / removed devices. After the scan a new LCT
+ *     will be fetched automatically.
+ *
+ *     Returns 0 on success or negative error code on failure.
+ */
+static int i2o_bus_scan(struct i2o_device *dev)
+{
+       struct i2o_message *msg;
+
+       msg = i2o_msg_get_wait(dev->iop, I2O_TIMEOUT_MESSAGE_GET);
+       if (IS_ERR(msg))
+               return -ETIMEDOUT;
+
+       msg->u.head[0] = cpu_to_le32(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0);
+       msg->u.head[1] =
+           cpu_to_le32(I2O_CMD_BUS_SCAN << 24 | HOST_TID << 12 | dev->lct_data.
+                       tid);
+
+       return i2o_msg_post_wait(dev->iop, msg, 60);
+};
+
+/**
+ *     i2o_bus_store_scan - Scan the I2O Bus Adapter
+ *     @d: device which should be scanned
+ *     @attr: device_attribute
+ *     @buf: output buffer
+ *     @count: buffer size
+ *
+ *     Returns count.
+ */
+static ssize_t i2o_bus_store_scan(struct device *d,
+                                 struct device_attribute *attr,
+                                 const char *buf, size_t count)
+{
+       struct i2o_device *i2o_dev = to_i2o_device(d);
+       int rc;
+
+       rc = i2o_bus_scan(i2o_dev);
+       if (rc)
+               osm_warn("bus scan failed %d\n", rc);
+
+       return count;
+}
+
+/* Bus Adapter OSM device attributes */
+static DEVICE_ATTR(scan, S_IWUSR, NULL, i2o_bus_store_scan);
+
+/**
+ *     i2o_bus_probe - verify if dev is a I2O Bus Adapter device and install it
+ *     @dev: device to verify if it is a I2O Bus Adapter device
+ *
+ *     Because we want all Bus Adapters always return 0.
+ *     Except when we fail.  Then we are sad.
+ *
+ *     Returns 0, except when we fail to excel.
+ */
+static int i2o_bus_probe(struct device *dev)
+{
+       struct i2o_device *i2o_dev = to_i2o_device(get_device(dev));
+       int rc;
+
+       rc = device_create_file(dev, &dev_attr_scan);
+       if (rc)
+               goto err_out;
+
+       osm_info("device added (TID: %03x)\n", i2o_dev->lct_data.tid);
+
+       return 0;
+
+err_out:
+       put_device(dev);
+       return rc;
+};
+
+/**
+ *     i2o_bus_remove - remove the I2O Bus Adapter device from the system again
+ *     @dev: I2O Bus Adapter device which should be removed
+ *
+ *     Always returns 0.
+ */
+static int i2o_bus_remove(struct device *dev)
+{
+       struct i2o_device *i2o_dev = to_i2o_device(dev);
+
+       device_remove_file(dev, &dev_attr_scan);
+
+       put_device(dev);
+
+       osm_info("device removed (TID: %03x)\n", i2o_dev->lct_data.tid);
+
+       return 0;
+};
+
+/* Bus Adapter OSM driver struct */
+static struct i2o_driver i2o_bus_driver = {
+       .name = OSM_NAME,
+       .classes = i2o_bus_class_id,
+       .driver = {
+                  .probe = i2o_bus_probe,
+                  .remove = i2o_bus_remove,
+                  },
+};
+
+/**
+ *     i2o_bus_init - Bus Adapter OSM initialization function
+ *
+ *     Only register the Bus Adapter OSM in the I2O core.
+ *
+ *     Returns 0 on success or negative error code on failure.
+ */
+static int __init i2o_bus_init(void)
+{
+       int rc;
+
+       printk(KERN_INFO OSM_DESCRIPTION " v" OSM_VERSION "\n");
+
+       /* Register Bus Adapter OSM into I2O core */
+       rc = i2o_driver_register(&i2o_bus_driver);
+       if (rc) {
+               osm_err("Could not register Bus Adapter OSM\n");
+               return rc;
+       }
+
+       return 0;
+};
+
+/**
+ *     i2o_bus_exit - Bus Adapter OSM exit function
+ *
+ *     Unregisters Bus Adapter OSM from I2O core.
+ */
+static void __exit i2o_bus_exit(void)
+{
+       i2o_driver_unregister(&i2o_bus_driver);
+};
+
+MODULE_AUTHOR("Markus Lidel <Markus.Lidel@shadowconnect.com>");
+MODULE_LICENSE("GPL");
+MODULE_DESCRIPTION(OSM_DESCRIPTION);
+MODULE_VERSION(OSM_VERSION);
+
+module_init(i2o_bus_init);
+module_exit(i2o_bus_exit);