diff options
Diffstat (limited to 'drivers/staging/hv/vmbus_drv.c')
-rw-r--r-- | drivers/staging/hv/vmbus_drv.c | 1228 |
1 files changed, 1228 insertions, 0 deletions
diff --git a/drivers/staging/hv/vmbus_drv.c b/drivers/staging/hv/vmbus_drv.c new file mode 100644 index 00000000000..0acf42c3566 --- /dev/null +++ b/drivers/staging/hv/vmbus_drv.c @@ -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 |