|
@@ -0,0 +1,1228 @@
|
|
|
+/*
|
|
|
+ *
|
|
|
+ * Copyright (c) 2009, Microsoft Corporation.
|
|
|
+ *
|
|
|
+ * This program is free software; you can redistribute it and/or modify it
|
|
|
+ * under the terms and conditions of the GNU General Public License,
|
|
|
+ * version 2, as published by the Free Software Foundation.
|
|
|
+ *
|
|
|
+ * This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
+ * more details.
|
|
|
+ *
|
|
|
+ * You should have received a copy of the GNU General Public License along with
|
|
|
+ * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
|
|
|
+ * Place - Suite 330, Boston, MA 02111-1307 USA.
|
|
|
+ *
|
|
|
+ * Authors:
|
|
|
+ * Haiyang Zhang <haiyangz@microsoft.com>
|
|
|
+ * Hank Janssen <hjanssen@microsoft.com>
|
|
|
+ *
|
|
|
+ */
|
|
|
+
|
|
|
+
|
|
|
+#include <linux/init.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <linux/device.h>
|
|
|
+#include <linux/irq.h>
|
|
|
+#include <linux/interrupt.h>
|
|
|
+#include <linux/sysctl.h>
|
|
|
+
|
|
|
+#include "logging.h"
|
|
|
+#include "vmbus.h"
|
|
|
+
|
|
|
+//
|
|
|
+// Defines
|
|
|
+//
|
|
|
+
|
|
|
+// FIXME! We need to do this dynamically for PIC and APIC system
|
|
|
+#define VMBUS_IRQ 0x5
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+#define VMBUS_IRQ_VECTOR IRQ5_VECTOR
|
|
|
+#endif
|
|
|
+//
|
|
|
+// Data types
|
|
|
+//
|
|
|
+
|
|
|
+// Main vmbus driver data structure
|
|
|
+struct vmbus_driver_context {
|
|
|
+ // !! These must be the first 2 fields !!
|
|
|
+ // The driver field is not used in here. Instead, the bus field is
|
|
|
+ // used to represent the driver
|
|
|
+ struct driver_context drv_ctx;
|
|
|
+ VMBUS_DRIVER_OBJECT drv_obj;
|
|
|
+
|
|
|
+ struct bus_type bus;
|
|
|
+ struct tasklet_struct msg_dpc;
|
|
|
+ struct tasklet_struct event_dpc;
|
|
|
+
|
|
|
+ // The bus root device
|
|
|
+ struct device_context device_ctx;
|
|
|
+};
|
|
|
+
|
|
|
+//
|
|
|
+// Static decl
|
|
|
+//
|
|
|
+static int vmbus_match(struct device *device, struct device_driver *driver);
|
|
|
+static int vmbus_probe(struct device *device);
|
|
|
+static int vmbus_remove(struct device *device);
|
|
|
+static void vmbus_shutdown(struct device *device);
|
|
|
+#if defined(KERNEL_2_6_5) || defined(KERNEL_2_6_9)
|
|
|
+#elif defined(KERNEL_2_6_27)
|
|
|
+static int vmbus_uevent(struct device *device, struct kobj_uevent_env *env);
|
|
|
+#else
|
|
|
+static int vmbus_uevent(struct device *device, char **envp, int num_envp, char *buffer, int buffer_size);
|
|
|
+#endif
|
|
|
+static void vmbus_msg_dpc(unsigned long data);
|
|
|
+static void vmbus_event_dpc(unsigned long data);
|
|
|
+
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+static irqreturn_t vmbus_isr(int irq, void* dev_id);
|
|
|
+#else
|
|
|
+static int vmbus_isr(int irq, void* dev_id, struct pt_regs *regs);
|
|
|
+#endif
|
|
|
+
|
|
|
+static void vmbus_device_release(struct device *device);
|
|
|
+static void vmbus_bus_release(struct device *device);
|
|
|
+
|
|
|
+static DEVICE_OBJECT* vmbus_child_device_create(GUID type, GUID instance, void* context);
|
|
|
+static void vmbus_child_device_destroy(DEVICE_OBJECT* device_obj);
|
|
|
+static int vmbus_child_device_register(DEVICE_OBJECT* root_device_obj, DEVICE_OBJECT* child_device_obj);
|
|
|
+static void vmbus_child_device_unregister(DEVICE_OBJECT* child_device_obj);
|
|
|
+static void vmbus_child_device_get_info(DEVICE_OBJECT *device_obj, DEVICE_INFO *device_info);
|
|
|
+
|
|
|
+//static ssize_t vmbus_show_class_id(struct device *dev, struct device_attribute *attr, char *buf);
|
|
|
+//static ssize_t vmbus_show_device_id(struct device *dev, struct device_attribute *attr, char *buf);
|
|
|
+
|
|
|
+static ssize_t vmbus_show_device_attr(struct device *dev, struct device_attribute *dev_attr, char *buf);
|
|
|
+
|
|
|
+//
|
|
|
+// Global
|
|
|
+//
|
|
|
+
|
|
|
+// Global logging setting
|
|
|
+
|
|
|
+//unsigned int vmbus_loglevel= (((VMBUS | VMBUS_DRV)<<16) | DEBUG_LVL_ENTEREXIT);
|
|
|
+//unsigned int vmbus_loglevel= (ALL_MODULES << 16 | DEBUG_LVL_ENTEREXIT);
|
|
|
+unsigned int vmbus_loglevel= (ALL_MODULES << 16 | INFO_LVL);
|
|
|
+EXPORT_SYMBOL(vmbus_loglevel);
|
|
|
+
|
|
|
+static int vmbus_irq = VMBUS_IRQ;
|
|
|
+
|
|
|
+// Setup /proc/sys/bus/vmbus/vmbus_loglevel
|
|
|
+// Allow usage of sysctl cmd to set the logging level
|
|
|
+static struct ctl_table_header *vmbus_ctl_table_hdr;
|
|
|
+
|
|
|
+static ctl_table vmbus_dev_ctl_table[] = {
|
|
|
+ { .ctl_name = 8461,
|
|
|
+ .procname = "vmbus_loglevel",
|
|
|
+ .data = &vmbus_loglevel,
|
|
|
+ .maxlen = sizeof(vmbus_loglevel),
|
|
|
+ .mode = 0644,
|
|
|
+ .proc_handler = &proc_dointvec },
|
|
|
+ { }
|
|
|
+};
|
|
|
+
|
|
|
+static ctl_table vmbus_ctl_table[] = {
|
|
|
+ { .ctl_name = CTL_DEV,
|
|
|
+ .procname = "vmbus",
|
|
|
+ .mode = 0555,
|
|
|
+ .child = vmbus_dev_ctl_table },
|
|
|
+ { }
|
|
|
+};
|
|
|
+
|
|
|
+static ctl_table vmus_root_ctl_table[] = {
|
|
|
+ { .ctl_name = CTL_BUS,
|
|
|
+ .procname = "bus",
|
|
|
+ .mode = 0555,
|
|
|
+ .child = vmbus_ctl_table },
|
|
|
+ { }
|
|
|
+};
|
|
|
+
|
|
|
+#if defined(KERNEL_2_6_5) || defined(KERNEL_2_6_9)
|
|
|
+#else
|
|
|
+//
|
|
|
+// Set up per device attributes in /sys/bus/vmbus/devices/<bus device>
|
|
|
+//
|
|
|
+static struct device_attribute vmbus_device_attrs[] = {
|
|
|
+ __ATTR(id, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(state, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(class_id, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(device_id, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(monitor_id, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+
|
|
|
+ __ATTR(server_monitor_pending, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(server_monitor_latency, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(server_monitor_conn_id, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+
|
|
|
+ __ATTR(client_monitor_pending, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(client_monitor_latency, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(client_monitor_conn_id, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+
|
|
|
+ __ATTR(out_intr_mask, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(out_read_index, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(out_write_index, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(out_read_bytes_avail, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(out_write_bytes_avail, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+
|
|
|
+ __ATTR(in_intr_mask, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(in_read_index, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(in_write_index, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(in_read_bytes_avail, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR(in_write_bytes_avail, S_IRUGO, vmbus_show_device_attr, NULL),
|
|
|
+ __ATTR_NULL
|
|
|
+};
|
|
|
+#endif
|
|
|
+
|
|
|
+// The one and only one
|
|
|
+static struct vmbus_driver_context g_vmbus_drv={
|
|
|
+ .bus.name = "vmbus",
|
|
|
+ .bus.match = vmbus_match,
|
|
|
+#if defined(KERNEL_2_6_5) || defined(KERNEL_2_6_9)
|
|
|
+#else
|
|
|
+ .bus.shutdown = vmbus_shutdown,
|
|
|
+ .bus.remove = vmbus_remove,
|
|
|
+ .bus.probe = vmbus_probe,
|
|
|
+ .bus.uevent = vmbus_uevent,
|
|
|
+ .bus.dev_attrs = vmbus_device_attrs,
|
|
|
+#endif
|
|
|
+};
|
|
|
+
|
|
|
+//
|
|
|
+// Routines
|
|
|
+//
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_show_device_attr()
|
|
|
+
|
|
|
+Desc: Show the device attribute in sysfs. This is invoked when user does a "cat /sys/bus/vmbus/devices/<bus device>/<attr name>"
|
|
|
+
|
|
|
+--*/
|
|
|
+static ssize_t vmbus_show_device_attr(struct device *dev, struct device_attribute *dev_attr, char *buf)
|
|
|
+{
|
|
|
+ struct device_context *device_ctx = device_to_device_context(dev);
|
|
|
+ DEVICE_INFO device_info;
|
|
|
+
|
|
|
+ memset(&device_info, 0, sizeof(DEVICE_INFO));
|
|
|
+
|
|
|
+ vmbus_child_device_get_info(&device_ctx->device_obj, &device_info);
|
|
|
+
|
|
|
+ if (!strcmp(dev_attr->attr.name, "class_id"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "{%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}\n",
|
|
|
+ device_info.ChannelType.Data[3], device_info.ChannelType.Data[2], device_info.ChannelType.Data[1], device_info.ChannelType.Data[0],
|
|
|
+ device_info.ChannelType.Data[5], device_info.ChannelType.Data[4],
|
|
|
+ device_info.ChannelType.Data[7], device_info.ChannelType.Data[6],
|
|
|
+ device_info.ChannelType.Data[8], device_info.ChannelType.Data[9], device_info.ChannelType.Data[10], device_info.ChannelType.Data[11], device_info.ChannelType.Data[12], device_info.ChannelType.Data[13], device_info.ChannelType.Data[14], device_info.ChannelType.Data[15]);
|
|
|
+
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "device_id"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "{%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}\n",
|
|
|
+ device_info.ChannelInstance.Data[3], device_info.ChannelInstance.Data[2], device_info.ChannelInstance.Data[1], device_info.ChannelInstance.Data[0],
|
|
|
+ device_info.ChannelInstance.Data[5], device_info.ChannelInstance.Data[4],
|
|
|
+ device_info.ChannelInstance.Data[7], device_info.ChannelInstance.Data[6],
|
|
|
+ device_info.ChannelInstance.Data[8], device_info.ChannelInstance.Data[9], device_info.ChannelInstance.Data[10], device_info.ChannelInstance.Data[11], device_info.ChannelInstance.Data[12], device_info.ChannelInstance.Data[13], device_info.ChannelInstance.Data[14], device_info.ChannelInstance.Data[15]);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "state"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ChannelState);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "id"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ChannelId);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "out_intr_mask"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Outbound.InterruptMask);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "out_read_index"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Outbound.ReadIndex);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "out_write_index"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Outbound.WriteIndex);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "out_read_bytes_avail"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Outbound.BytesAvailToRead);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "out_write_bytes_avail"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Outbound.BytesAvailToWrite);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "in_intr_mask"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Inbound.InterruptMask);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "in_read_index"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Inbound.ReadIndex);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "in_write_index"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Inbound.WriteIndex);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "in_read_bytes_avail"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Inbound.BytesAvailToRead);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "in_write_bytes_avail"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.Inbound.BytesAvailToWrite);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "monitor_id"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.MonitorId);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "server_monitor_pending"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ServerMonitorPending);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "server_monitor_latency"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ServerMonitorLatency);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "server_monitor_conn_id"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ServerMonitorConnectionId);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "client_monitor_pending"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ClientMonitorPending);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "client_monitor_latency"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ClientMonitorLatency);
|
|
|
+ }
|
|
|
+ else if (!strcmp(dev_attr->attr.name, "client_monitor_conn_id"))
|
|
|
+ {
|
|
|
+ return sprintf(buf, "%d\n", device_info.ClientMonitorConnectionId);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_show_class_id()
|
|
|
+
|
|
|
+Desc: Show the device class id in sysfs
|
|
|
+
|
|
|
+--*/
|
|
|
+//static ssize_t vmbus_show_class_id(struct device *dev, struct device_attribute *attr, char *buf)
|
|
|
+//{
|
|
|
+// struct device_context *device_ctx = device_to_device_context(dev);
|
|
|
+// return sprintf(buf, "{%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}\n",
|
|
|
+// device_ctx->class_id[3], device_ctx->class_id[2], device_ctx->class_id[1], device_ctx->class_id[0],
|
|
|
+// device_ctx->class_id[5], device_ctx->class_id[4],
|
|
|
+// device_ctx->class_id[7], device_ctx->class_id[6],
|
|
|
+// device_ctx->class_id[8], device_ctx->class_id[9], device_ctx->class_id[10], device_ctx->class_id[11], device_ctx->class_id[12], device_ctx->class_id[13], device_ctx->class_id[14], device_ctx->class_id[15]);
|
|
|
+//}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_show_device_id()
|
|
|
+
|
|
|
+Desc: Show the device instance id in sysfs
|
|
|
+
|
|
|
+--*/
|
|
|
+//static ssize_t vmbus_show_device_id(struct device *dev, struct device_attribute *attr, char *buf)
|
|
|
+//{
|
|
|
+// struct device_context *device_ctx = device_to_device_context(dev);
|
|
|
+// return sprintf(buf, "{%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}\n",
|
|
|
+// device_ctx->device_id[3], device_ctx->device_id[2], device_ctx->device_id[1], device_ctx->device_id[0],
|
|
|
+// device_ctx->device_id[5], device_ctx->device_id[4],
|
|
|
+// device_ctx->device_id[7], device_ctx->device_id[6],
|
|
|
+// device_ctx->device_id[8], device_ctx->device_id[9], device_ctx->device_id[10], device_ctx->device_id[11], device_ctx->device_id[12], device_ctx->device_id[13], device_ctx->device_id[14], device_ctx->device_id[15]);
|
|
|
+//}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_bus_init()
|
|
|
+
|
|
|
+Desc: Main vmbus driver initialization routine. Here, we
|
|
|
+ - initialize the vmbus driver context
|
|
|
+ - setup various driver entry points
|
|
|
+ - invoke the vmbus hv main init routine
|
|
|
+ - get the irq resource
|
|
|
+ - invoke the vmbus to add the vmbus root device
|
|
|
+ - setup the vmbus root device
|
|
|
+ - retrieve the channel offers
|
|
|
+--*/
|
|
|
+int vmbus_bus_init(PFN_DRIVERINITIALIZE pfn_drv_init)
|
|
|
+{
|
|
|
+ int ret=0;
|
|
|
+ unsigned int vector=0;
|
|
|
+
|
|
|
+ struct vmbus_driver_context *vmbus_drv_ctx=&g_vmbus_drv;
|
|
|
+ VMBUS_DRIVER_OBJECT *vmbus_drv_obj=&g_vmbus_drv.drv_obj;
|
|
|
+
|
|
|
+ struct device_context *dev_ctx=&g_vmbus_drv.device_ctx;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Set this up to allow lower layer to callback to add/remove child devices on the bus
|
|
|
+ vmbus_drv_obj->OnChildDeviceCreate = vmbus_child_device_create;
|
|
|
+ vmbus_drv_obj->OnChildDeviceDestroy = vmbus_child_device_destroy;
|
|
|
+ vmbus_drv_obj->OnChildDeviceAdd = vmbus_child_device_register;
|
|
|
+ vmbus_drv_obj->OnChildDeviceRemove = vmbus_child_device_unregister;
|
|
|
+
|
|
|
+ // Call to bus driver to initialize
|
|
|
+ ret = pfn_drv_init(&vmbus_drv_obj->Base);
|
|
|
+ if (ret != 0)
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "Unable to initialize vmbus (%d)", ret);
|
|
|
+ goto cleanup;
|
|
|
+ }
|
|
|
+
|
|
|
+ // Sanity checks
|
|
|
+ if (!vmbus_drv_obj->Base.OnDeviceAdd)
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "OnDeviceAdd() routine not set");
|
|
|
+ ret = -1;
|
|
|
+ goto cleanup;
|
|
|
+ }
|
|
|
+
|
|
|
+ vmbus_drv_ctx->bus.name = vmbus_drv_obj->Base.name;
|
|
|
+
|
|
|
+ // Initialize the bus context
|
|
|
+ tasklet_init(&vmbus_drv_ctx->msg_dpc, vmbus_msg_dpc, (unsigned long)vmbus_drv_obj);
|
|
|
+ tasklet_init(&vmbus_drv_ctx->event_dpc, vmbus_event_dpc, (unsigned long)vmbus_drv_obj);
|
|
|
+
|
|
|
+ // Now, register the bus driver with LDM
|
|
|
+ bus_register(&vmbus_drv_ctx->bus);
|
|
|
+
|
|
|
+ // Get the interrupt resource
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+ ret = request_irq(vmbus_irq,
|
|
|
+ vmbus_isr,
|
|
|
+ IRQF_SAMPLE_RANDOM,
|
|
|
+ vmbus_drv_obj->Base.name,
|
|
|
+ NULL);
|
|
|
+#else
|
|
|
+ ret = request_irq(vmbus_irq,
|
|
|
+ vmbus_isr,
|
|
|
+ SA_SAMPLE_RANDOM,
|
|
|
+ vmbus_drv_obj->Base.name,
|
|
|
+ NULL);
|
|
|
+#endif
|
|
|
+
|
|
|
+ if (ret != 0)
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "ERROR - Unable to request IRQ %d", vmbus_irq);
|
|
|
+
|
|
|
+ bus_unregister(&vmbus_drv_ctx->bus);
|
|
|
+
|
|
|
+ ret = -1;
|
|
|
+ goto cleanup;
|
|
|
+ }
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+ vector = VMBUS_IRQ_VECTOR;
|
|
|
+#else
|
|
|
+#if X2V_LINUX
|
|
|
+ vector = vmbus_irq + FIRST_DEVICE_VECTOR - 2;
|
|
|
+#else
|
|
|
+ vector = vmbus_irq + FIRST_EXTERNAL_VECTOR;
|
|
|
+#endif
|
|
|
+#endif
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "irq 0x%x vector 0x%x", vmbus_irq, vector);
|
|
|
+
|
|
|
+ // Call to bus driver to add the root device
|
|
|
+ memset(dev_ctx, 0, sizeof(struct device_context));
|
|
|
+
|
|
|
+ ret = vmbus_drv_obj->Base.OnDeviceAdd(&dev_ctx->device_obj, &vector);
|
|
|
+ if (ret != 0)
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "ERROR - Unable to add vmbus root device");
|
|
|
+
|
|
|
+ free_irq(vmbus_irq, NULL);
|
|
|
+
|
|
|
+ bus_unregister(&vmbus_drv_ctx->bus);
|
|
|
+
|
|
|
+ ret = -1;
|
|
|
+ goto cleanup;
|
|
|
+ }
|
|
|
+ //strcpy(dev_ctx->device.bus_id, dev_ctx->device_obj.name);
|
|
|
+ sprintf(dev_ctx->device.bus_id, "vmbus_0_0");
|
|
|
+ memcpy(&dev_ctx->class_id, &dev_ctx->device_obj.deviceType, sizeof(GUID));
|
|
|
+ memcpy(&dev_ctx->device_id, &dev_ctx->device_obj.deviceInstance, sizeof(GUID));
|
|
|
+
|
|
|
+ // No need to bind a driver to the root device.
|
|
|
+ dev_ctx->device.parent = NULL;
|
|
|
+ dev_ctx->device.bus = &vmbus_drv_ctx->bus; //NULL; // vmbus_remove() does not get invoked
|
|
|
+
|
|
|
+ // Setup the device dispatch table
|
|
|
+ dev_ctx->device.release = vmbus_bus_release;
|
|
|
+
|
|
|
+ // Setup the bus as root device
|
|
|
+ device_register(&dev_ctx->device);
|
|
|
+
|
|
|
+ vmbus_drv_obj->GetChannelOffers();
|
|
|
+
|
|
|
+cleanup:
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_bus_exit()
|
|
|
+
|
|
|
+Desc: Terminate the vmbus driver. This routine is opposite of vmbus_bus_init()
|
|
|
+
|
|
|
+--*/
|
|
|
+void vmbus_bus_exit(void)
|
|
|
+{
|
|
|
+ VMBUS_DRIVER_OBJECT *vmbus_drv_obj=&g_vmbus_drv.drv_obj;
|
|
|
+ struct vmbus_driver_context *vmbus_drv_ctx=&g_vmbus_drv;
|
|
|
+
|
|
|
+ struct device_context *dev_ctx=&g_vmbus_drv.device_ctx;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Remove the root device
|
|
|
+ if (vmbus_drv_obj->Base.OnDeviceRemove)
|
|
|
+ vmbus_drv_obj->Base.OnDeviceRemove(&dev_ctx->device_obj);
|
|
|
+
|
|
|
+ if (vmbus_drv_obj->Base.OnCleanup)
|
|
|
+ vmbus_drv_obj->Base.OnCleanup(&vmbus_drv_obj->Base);
|
|
|
+
|
|
|
+ // Unregister the root bus device
|
|
|
+ device_unregister(&dev_ctx->device);
|
|
|
+
|
|
|
+ bus_unregister(&vmbus_drv_ctx->bus);
|
|
|
+
|
|
|
+ free_irq(vmbus_irq, NULL);
|
|
|
+
|
|
|
+ tasklet_kill(&vmbus_drv_ctx->msg_dpc);
|
|
|
+ tasklet_kill(&vmbus_drv_ctx->event_dpc);
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_driver_register()
|
|
|
+
|
|
|
+Desc: Register a vmbus's child driver
|
|
|
+
|
|
|
+--*/
|
|
|
+void vmbus_child_driver_register(struct driver_context* driver_ctx)
|
|
|
+{
|
|
|
+ VMBUS_DRIVER_OBJECT *vmbus_drv_obj=&g_vmbus_drv.drv_obj;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "child driver (%p) registering - name %s", driver_ctx, driver_ctx->driver.name);
|
|
|
+
|
|
|
+ // The child driver on this vmbus
|
|
|
+ driver_ctx->driver.bus = &g_vmbus_drv.bus;
|
|
|
+
|
|
|
+ driver_register(&driver_ctx->driver);
|
|
|
+
|
|
|
+ vmbus_drv_obj->GetChannelOffers();
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+EXPORT_SYMBOL(vmbus_child_driver_register);
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_driver_unregister()
|
|
|
+
|
|
|
+Desc: Unregister a vmbus's child driver
|
|
|
+
|
|
|
+--*/
|
|
|
+void vmbus_child_driver_unregister(struct driver_context* driver_ctx)
|
|
|
+{
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "child driver (%p) unregistering - name %s", driver_ctx, driver_ctx->driver.name);
|
|
|
+
|
|
|
+ driver_unregister(&driver_ctx->driver);
|
|
|
+
|
|
|
+ driver_ctx->driver.bus = NULL;
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+EXPORT_SYMBOL(vmbus_child_driver_unregister);
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_get_interface()
|
|
|
+
|
|
|
+Desc: Get the vmbus channel interface. This is invoked by child/client driver that sits
|
|
|
+ above vmbus
|
|
|
+--*/
|
|
|
+void vmbus_get_interface(VMBUS_CHANNEL_INTERFACE *interface)
|
|
|
+{
|
|
|
+ VMBUS_DRIVER_OBJECT *vmbus_drv_obj=&g_vmbus_drv.drv_obj;
|
|
|
+
|
|
|
+ vmbus_drv_obj->GetChannelInterface(interface);
|
|
|
+}
|
|
|
+
|
|
|
+EXPORT_SYMBOL(vmbus_get_interface);
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_device_get_info()
|
|
|
+
|
|
|
+Desc: Get the vmbus child device info. This is invoked to display various device attributes in sysfs.
|
|
|
+--*/
|
|
|
+static void vmbus_child_device_get_info(DEVICE_OBJECT *device_obj, DEVICE_INFO *device_info)
|
|
|
+{
|
|
|
+ VMBUS_DRIVER_OBJECT *vmbus_drv_obj=&g_vmbus_drv.drv_obj;
|
|
|
+
|
|
|
+ vmbus_drv_obj->GetChannelInfo(device_obj, device_info);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_device_create()
|
|
|
+
|
|
|
+Desc: Creates and registers a new child device on the vmbus.
|
|
|
+
|
|
|
+--*/
|
|
|
+static DEVICE_OBJECT* vmbus_child_device_create(GUID type, GUID instance, void* context)
|
|
|
+{
|
|
|
+ struct device_context *child_device_ctx;
|
|
|
+ DEVICE_OBJECT* child_device_obj;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Allocate the new child device
|
|
|
+ child_device_ctx = kzalloc(sizeof(struct device_context), GFP_KERNEL);
|
|
|
+ if (!child_device_ctx)
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "unable to allocate device_context for child device");
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return NULL;
|
|
|
+ }
|
|
|
+
|
|
|
+ DPRINT_DBG(VMBUS_DRV, "child device (%p) allocated - "
|
|
|
+ "type {%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x},"
|
|
|
+ "id {%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ &child_device_ctx->device,
|
|
|
+ type.Data[3], type.Data[2], type.Data[1], type.Data[0], type.Data[5], type.Data[4], type.Data[7], type.Data[6], type.Data[8], type.Data[9], type.Data[10], type.Data[11], type.Data[12], type.Data[13], type.Data[14], type.Data[15],
|
|
|
+ instance.Data[3], instance.Data[2], instance.Data[1], instance.Data[0], instance.Data[5], instance.Data[4], instance.Data[7], instance.Data[6], instance.Data[8], instance.Data[9], instance.Data[10], instance.Data[11], instance.Data[12], instance.Data[13], instance.Data[14], instance.Data[15]);
|
|
|
+
|
|
|
+ child_device_obj = &child_device_ctx->device_obj;
|
|
|
+ child_device_obj->context = context;
|
|
|
+ memcpy(&child_device_obj->deviceType, &type, sizeof(GUID));
|
|
|
+ memcpy(&child_device_obj->deviceInstance, &instance, sizeof(GUID));
|
|
|
+
|
|
|
+ memcpy(&child_device_ctx->class_id, &type, sizeof(GUID));
|
|
|
+ memcpy(&child_device_ctx->device_id, &instance, sizeof(GUID));
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return child_device_obj;
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_device_register()
|
|
|
+
|
|
|
+Desc: Register the child device on the specified bus
|
|
|
+
|
|
|
+--*/
|
|
|
+static int vmbus_child_device_register(DEVICE_OBJECT* root_device_obj, DEVICE_OBJECT* child_device_obj)
|
|
|
+{
|
|
|
+ int ret=0;
|
|
|
+ struct device_context *root_device_ctx = to_device_context(root_device_obj);
|
|
|
+ struct device_context *child_device_ctx = to_device_context(child_device_obj);
|
|
|
+ static int device_num=0;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_DBG(VMBUS_DRV, "child device (%p) registering", child_device_ctx);
|
|
|
+ //
|
|
|
+ // Make sure we are not registered already
|
|
|
+ //
|
|
|
+ if (child_device_ctx->device.bus_id[0] != '\0')
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "child device (%p) already registered - busid %s", child_device_ctx, child_device_ctx->device.bus_id);
|
|
|
+
|
|
|
+ ret = -1;
|
|
|
+ goto Cleanup;
|
|
|
+ }
|
|
|
+
|
|
|
+ // Set the device bus id. Otherwise, device_register()will fail.
|
|
|
+ sprintf(child_device_ctx->device.bus_id, "vmbus_0_%d", InterlockedIncrement(&device_num));
|
|
|
+
|
|
|
+ // The new device belongs to this bus
|
|
|
+ child_device_ctx->device.bus = &g_vmbus_drv.bus; //device->dev.bus;
|
|
|
+ child_device_ctx->device.parent = &root_device_ctx->device;
|
|
|
+ child_device_ctx->device.release = vmbus_device_release;
|
|
|
+
|
|
|
+ // Register with the LDM. This will kick off the driver/device binding...which will
|
|
|
+ // eventually call vmbus_match() and vmbus_probe()
|
|
|
+ ret = device_register(&child_device_ctx->device);
|
|
|
+
|
|
|
+ // vmbus_probe() error does not get propergate to device_register().
|
|
|
+ ret = child_device_ctx->probe_error;
|
|
|
+
|
|
|
+ if (ret)
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "unable to register child device (%p) (%d)", &child_device_ctx->device);
|
|
|
+ else
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "child device (%p) registered", &child_device_ctx->device);
|
|
|
+
|
|
|
+Cleanup:
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_device_unregister()
|
|
|
+
|
|
|
+Desc: Remove the specified child device from the vmbus.
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_child_device_unregister(DEVICE_OBJECT* device_obj)
|
|
|
+{
|
|
|
+ struct device_context *device_ctx = to_device_context(device_obj);
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "unregistering child device (%p)", &device_ctx->device);
|
|
|
+
|
|
|
+ // Kick off the process of unregistering the device.
|
|
|
+ // This will call vmbus_remove() and eventually vmbus_device_release()
|
|
|
+ device_unregister(&device_ctx->device);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "child device (%p) unregistered", &device_ctx->device);
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_child_device_destroy()
|
|
|
+
|
|
|
+Desc: Destroy the specified child device on the vmbus.
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_child_device_destroy(DEVICE_OBJECT* device_obj)
|
|
|
+{
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_uevent()
|
|
|
+
|
|
|
+Desc: This routine is invoked when a device is added or removed on the vmbus to generate a uevent to udev in the
|
|
|
+ userspace. The udev will then look at its rule and the uevent generated here to load the appropriate driver
|
|
|
+
|
|
|
+--*/
|
|
|
+#if defined(KERNEL_2_6_5) || defined(KERNEL_2_6_9)
|
|
|
+#elif defined(KERNEL_2_6_27)
|
|
|
+static int vmbus_uevent(struct device *device, struct kobj_uevent_env *env)
|
|
|
+{
|
|
|
+ struct device_context *device_ctx = device_to_device_context(device);
|
|
|
+ int i=0;
|
|
|
+ int len=0;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "generating uevent - VMBUS_DEVICE_CLASS_GUID={%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ device_ctx->class_id.Data[3], device_ctx->class_id.Data[2], device_ctx->class_id.Data[1], device_ctx->class_id.Data[0],
|
|
|
+ device_ctx->class_id.Data[5], device_ctx->class_id.Data[4],
|
|
|
+ device_ctx->class_id.Data[7], device_ctx->class_id.Data[6],
|
|
|
+ device_ctx->class_id.Data[8], device_ctx->class_id.Data[9], device_ctx->class_id.Data[10], device_ctx->class_id.Data[11],
|
|
|
+ device_ctx->class_id.Data[12], device_ctx->class_id.Data[13], device_ctx->class_id.Data[14], device_ctx->class_id.Data[15]);
|
|
|
+
|
|
|
+ env->envp_idx = i;
|
|
|
+ env->buflen = len;
|
|
|
+ ret = add_uevent_var(env,
|
|
|
+ "VMBUS_DEVICE_CLASS_GUID={%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ device_ctx->class_id.Data[3], device_ctx->class_id.Data[2], device_ctx->class_id.Data[1], device_ctx->class_id.Data[0],
|
|
|
+ device_ctx->class_id.Data[5], device_ctx->class_id.Data[4],
|
|
|
+ device_ctx->class_id.Data[7], device_ctx->class_id.Data[6],
|
|
|
+ device_ctx->class_id.Data[8], device_ctx->class_id.Data[9], device_ctx->class_id.Data[10], device_ctx->class_id.Data[11],
|
|
|
+ device_ctx->class_id.Data[12], device_ctx->class_id.Data[13], device_ctx->class_id.Data[14], device_ctx->class_id.Data[15]);
|
|
|
+
|
|
|
+ if (ret)
|
|
|
+ {
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = add_uevent_var(env,
|
|
|
+ "VMBUS_DEVICE_DEVICE_GUID={%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ device_ctx->device_id.Data[3], device_ctx->device_id.Data[2], device_ctx->device_id.Data[1], device_ctx->device_id.Data[0],
|
|
|
+ device_ctx->device_id.Data[5], device_ctx->device_id.Data[4],
|
|
|
+ device_ctx->device_id.Data[7], device_ctx->device_id.Data[6],
|
|
|
+ device_ctx->device_id.Data[8], device_ctx->device_id.Data[9], device_ctx->device_id.Data[10], device_ctx->device_id.Data[11],
|
|
|
+ device_ctx->device_id.Data[12], device_ctx->device_id.Data[13], device_ctx->device_id.Data[14], device_ctx->device_id.Data[15]);
|
|
|
+
|
|
|
+ if (ret)
|
|
|
+ {
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ env->envp[env->envp_idx] = NULL;
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+#else
|
|
|
+static int vmbus_uevent(struct device *device, char **envp, int num_envp, char *buffer, int buffer_size)
|
|
|
+{
|
|
|
+ struct device_context *device_ctx = device_to_device_context(device);
|
|
|
+ int i=0;
|
|
|
+ int len=0;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "generating uevent - VMBUS_DEVICE_CLASS_GUID={%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ device_ctx->class_id.Data[3], device_ctx->class_id.Data[2], device_ctx->class_id.Data[1], device_ctx->class_id.Data[0],
|
|
|
+ device_ctx->class_id.Data[5], device_ctx->class_id.Data[4],
|
|
|
+ device_ctx->class_id.Data[7], device_ctx->class_id.Data[6],
|
|
|
+ device_ctx->class_id.Data[8], device_ctx->class_id.Data[9], device_ctx->class_id.Data[10], device_ctx->class_id.Data[11],
|
|
|
+ device_ctx->class_id.Data[12], device_ctx->class_id.Data[13], device_ctx->class_id.Data[14], device_ctx->class_id.Data[15]);
|
|
|
+
|
|
|
+ ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size, &len,
|
|
|
+ "VMBUS_DEVICE_CLASS_GUID={%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ device_ctx->class_id.Data[3], device_ctx->class_id.Data[2], device_ctx->class_id.Data[1], device_ctx->class_id.Data[0],
|
|
|
+ device_ctx->class_id.Data[5], device_ctx->class_id.Data[4],
|
|
|
+ device_ctx->class_id.Data[7], device_ctx->class_id.Data[6],
|
|
|
+ device_ctx->class_id.Data[8], device_ctx->class_id.Data[9], device_ctx->class_id.Data[10], device_ctx->class_id.Data[11],
|
|
|
+ device_ctx->class_id.Data[12], device_ctx->class_id.Data[13], device_ctx->class_id.Data[14], device_ctx->class_id.Data[15]);
|
|
|
+
|
|
|
+ if (ret)
|
|
|
+ {
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size, &len,
|
|
|
+ "VMBUS_DEVICE_DEVICE_GUID={%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x%02x%02x}",
|
|
|
+ device_ctx->device_id.Data[3], device_ctx->device_id.Data[2], device_ctx->device_id.Data[1], device_ctx->device_id.Data[0],
|
|
|
+ device_ctx->device_id.Data[5], device_ctx->device_id.Data[4],
|
|
|
+ device_ctx->device_id.Data[7], device_ctx->device_id.Data[6],
|
|
|
+ device_ctx->device_id.Data[8], device_ctx->device_id.Data[9], device_ctx->device_id.Data[10], device_ctx->device_id.Data[11],
|
|
|
+ device_ctx->device_id.Data[12], device_ctx->device_id.Data[13], device_ctx->device_id.Data[14], device_ctx->device_id.Data[15]);
|
|
|
+
|
|
|
+ if (ret)
|
|
|
+ {
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ envp[i] = NULL;
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_match()
|
|
|
+
|
|
|
+Desc: Attempt to match the specified device to the specified driver
|
|
|
+
|
|
|
+--*/
|
|
|
+static int vmbus_match(struct device *device, struct device_driver *driver)
|
|
|
+{
|
|
|
+ int match=0;
|
|
|
+ struct driver_context *driver_ctx = driver_to_driver_context(driver);
|
|
|
+ struct device_context *device_ctx = device_to_device_context(device);
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // We found our driver ?
|
|
|
+ if (memcmp(&device_ctx->class_id, &driver_ctx->class_id, sizeof(GUID)) == 0)
|
|
|
+ {
|
|
|
+ // !! NOTE: The driver_ctx is not a vmbus_drv_ctx. We typecast it here to access the
|
|
|
+ // DRIVER_OBJECT field
|
|
|
+ struct vmbus_driver_context *vmbus_drv_ctx = (struct vmbus_driver_context*)driver_ctx;
|
|
|
+ device_ctx->device_obj.Driver = &vmbus_drv_ctx->drv_obj.Base;
|
|
|
+ DPRINT_INFO(VMBUS_DRV, "device object (%p) set to driver object (%p)", &device_ctx->device_obj, device_ctx->device_obj.Driver);
|
|
|
+
|
|
|
+ match = 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return match;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_probe_failed_cb()
|
|
|
+
|
|
|
+Desc: Callback when a driver probe failed in vmbus_probe(). We need a callback because
|
|
|
+ we cannot invoked device_unregister() inside vmbus_probe() since vmbus_probe() may be
|
|
|
+ invoked inside device_register() i.e. we cannot call device_unregister() inside
|
|
|
+ device_register()
|
|
|
+--*/
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+static void vmbus_probe_failed_cb(struct work_struct *context)
|
|
|
+#else
|
|
|
+static void vmbus_probe_failed_cb(void* context)
|
|
|
+#endif
|
|
|
+{
|
|
|
+ struct device_context *device_ctx = (struct device_context*)context;
|
|
|
+
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Kick off the process of unregistering the device.
|
|
|
+ // This will call vmbus_remove() and eventually vmbus_device_release()
|
|
|
+ device_unregister(&device_ctx->device);
|
|
|
+
|
|
|
+ //put_device(&device_ctx->device);
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_probe()
|
|
|
+
|
|
|
+Desc: Add the new vmbus's child device
|
|
|
+
|
|
|
+--*/
|
|
|
+static int vmbus_probe(struct device *child_device)
|
|
|
+{
|
|
|
+ int ret=0;
|
|
|
+ struct driver_context *driver_ctx = driver_to_driver_context(child_device->driver);
|
|
|
+ struct device_context *device_ctx = device_to_device_context(child_device);
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Let the specific open-source driver handles the probe if it can
|
|
|
+ if (driver_ctx->probe)
|
|
|
+ {
|
|
|
+ ret = device_ctx->probe_error = driver_ctx->probe(child_device);
|
|
|
+ if (ret != 0)
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "probe() failed for device %s (%p) on driver %s (%d)...", child_device->bus_id, child_device, child_device->driver->name, ret);
|
|
|
+
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+ INIT_WORK(&device_ctx->probe_failed_work_item, vmbus_probe_failed_cb);
|
|
|
+#else
|
|
|
+ INIT_WORK(&device_ctx->probe_failed_work_item, vmbus_probe_failed_cb, device_ctx);
|
|
|
+#endif
|
|
|
+ schedule_work(&device_ctx->probe_failed_work_item);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "probe() method not set for driver - %s", child_device->driver->name);
|
|
|
+ ret = -1;
|
|
|
+ }
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_remove()
|
|
|
+
|
|
|
+Desc: Remove a vmbus device
|
|
|
+
|
|
|
+--*/
|
|
|
+static int vmbus_remove(struct device *child_device)
|
|
|
+{
|
|
|
+ int ret=0;
|
|
|
+ struct driver_context *driver_ctx;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Special case root bus device
|
|
|
+ if (child_device->parent == NULL)
|
|
|
+ {
|
|
|
+ // No-op since it is statically defined and handle in vmbus_bus_exit()
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (child_device->driver)
|
|
|
+ {
|
|
|
+ driver_ctx = driver_to_driver_context(child_device->driver);
|
|
|
+
|
|
|
+ // Let the specific open-source driver handles the removal if it can
|
|
|
+ if (driver_ctx->remove)
|
|
|
+ {
|
|
|
+ ret = driver_ctx->remove(child_device);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ DPRINT_ERR(VMBUS_DRV, "remove() method not set for driver - %s", child_device->driver->name);
|
|
|
+ ret = -1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+
|
|
|
+ }
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_shutdown()
|
|
|
+
|
|
|
+Desc: Shutdown a vmbus device
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_shutdown(struct device *child_device)
|
|
|
+{
|
|
|
+ struct driver_context *driver_ctx;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ // Special case root bus device
|
|
|
+ if (child_device->parent == NULL)
|
|
|
+ {
|
|
|
+ // No-op since it is statically defined and handle in vmbus_bus_exit()
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ // The device may not be attached yet
|
|
|
+ if (!child_device->driver)
|
|
|
+ {
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ driver_ctx = driver_to_driver_context(child_device->driver);
|
|
|
+
|
|
|
+ // Let the specific open-source driver handles the removal if it can
|
|
|
+ if (driver_ctx->shutdown)
|
|
|
+ {
|
|
|
+ driver_ctx->shutdown(child_device);
|
|
|
+ }
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_bus_release()
|
|
|
+
|
|
|
+Desc: Final callback release of the vmbus root device
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_bus_release(struct device *device)
|
|
|
+{
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_device_release()
|
|
|
+
|
|
|
+Desc: Final callback release of the vmbus child device
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_device_release(struct device *device)
|
|
|
+{
|
|
|
+ struct device_context *device_ctx = device_to_device_context(device);
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ //vmbus_child_device_destroy(&device_ctx->device_obj);
|
|
|
+ kfree(device_ctx);
|
|
|
+
|
|
|
+ // !!DO NOT REFERENCE device_ctx anymore at this point!!
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_msg_dpc()
|
|
|
+
|
|
|
+Desc: Tasklet routine to handle hypervisor messages
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_msg_dpc(unsigned long data)
|
|
|
+{
|
|
|
+ VMBUS_DRIVER_OBJECT* vmbus_drv_obj = (VMBUS_DRIVER_OBJECT*)data;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ ASSERT(vmbus_drv_obj->OnMsgDpc != NULL);
|
|
|
+
|
|
|
+ // Call to bus driver to handle interrupt
|
|
|
+ vmbus_drv_obj->OnMsgDpc(&vmbus_drv_obj->Base);
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_msg_dpc()
|
|
|
+
|
|
|
+Desc: Tasklet routine to handle hypervisor events
|
|
|
+
|
|
|
+--*/
|
|
|
+static void vmbus_event_dpc(unsigned long data)
|
|
|
+{
|
|
|
+ VMBUS_DRIVER_OBJECT* vmbus_drv_obj = (VMBUS_DRIVER_OBJECT*)data;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ ASSERT(vmbus_drv_obj->OnEventDpc != NULL);
|
|
|
+
|
|
|
+ // Call to bus driver to handle interrupt
|
|
|
+ vmbus_drv_obj->OnEventDpc(&vmbus_drv_obj->Base);
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+}
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_msg_dpc()
|
|
|
+
|
|
|
+Desc: ISR routine
|
|
|
+
|
|
|
+--*/
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+static irqreturn_t vmbus_isr(int irq, void* dev_id)
|
|
|
+#else
|
|
|
+static int vmbus_isr(int irq, void* dev_id, struct pt_regs *regs)
|
|
|
+#endif
|
|
|
+{
|
|
|
+ int ret=0;
|
|
|
+ VMBUS_DRIVER_OBJECT* vmbus_driver_obj = &g_vmbus_drv.drv_obj;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ ASSERT(vmbus_driver_obj->OnIsr != NULL);
|
|
|
+
|
|
|
+ // Call to bus driver to handle interrupt
|
|
|
+ ret = vmbus_driver_obj->OnIsr(&vmbus_driver_obj->Base);
|
|
|
+
|
|
|
+ // Schedules a dpc if necessary
|
|
|
+ if (ret > 0)
|
|
|
+ {
|
|
|
+ if (test_bit(0, (unsigned long*)&ret))
|
|
|
+ {
|
|
|
+ tasklet_schedule(&g_vmbus_drv.msg_dpc);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (test_bit(1, (unsigned long*)&ret))
|
|
|
+ {
|
|
|
+ tasklet_schedule(&g_vmbus_drv.event_dpc);
|
|
|
+ }
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return IRQ_HANDLED;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return IRQ_NONE;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+MODULE_LICENSE("GPL");
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_init()
|
|
|
+
|
|
|
+Desc: Main vmbus driver entry routine
|
|
|
+
|
|
|
+--*/
|
|
|
+static int __init vmbus_init(void)
|
|
|
+{
|
|
|
+ int ret=0;
|
|
|
+
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ DPRINT_INFO(VMBUS_DRV,
|
|
|
+ "Vmbus initializing.... current log level 0x%x (%x,%x)",
|
|
|
+ vmbus_loglevel, HIWORD(vmbus_loglevel), LOWORD(vmbus_loglevel));
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+//Todo: it is used for loglevel, to be ported to new kernel.
|
|
|
+#else
|
|
|
+ vmbus_ctl_table_hdr = register_sysctl_table(vmus_root_ctl_table, 0);
|
|
|
+ if (!vmbus_ctl_table_hdr)
|
|
|
+ {
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ ret = vmbus_bus_init(VmbusInitialize);
|
|
|
+
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+/*++
|
|
|
+
|
|
|
+Name: vmbus_init()
|
|
|
+
|
|
|
+Desc: Main vmbus driver exit routine
|
|
|
+
|
|
|
+--*/
|
|
|
+static void __exit vmbus_exit(void)
|
|
|
+{
|
|
|
+ DPRINT_ENTER(VMBUS_DRV);
|
|
|
+
|
|
|
+ vmbus_bus_exit();
|
|
|
+#ifdef KERNEL_2_6_27
|
|
|
+//Todo: it is used for loglevel, to be ported to new kernel.
|
|
|
+#else
|
|
|
+ unregister_sysctl_table(vmbus_ctl_table_hdr);
|
|
|
+#endif
|
|
|
+ DPRINT_EXIT(VMBUS_DRV);
|
|
|
+
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+#if defined(KERNEL_2_6_5)
|
|
|
+#else
|
|
|
+module_param(vmbus_irq, int, S_IRUGO);
|
|
|
+module_param(vmbus_loglevel, int, S_IRUGO);
|
|
|
+#endif
|
|
|
+
|
|
|
+module_init(vmbus_init);
|
|
|
+module_exit(vmbus_exit);
|
|
|
+// eof
|