diff options
Diffstat (limited to 'drivers/staging/hv/vmbus_drv.c')
| -rw-r--r-- | drivers/staging/hv/vmbus_drv.c | 1105 |
1 files changed, 1105 insertions, 0 deletions
diff --git a/drivers/staging/hv/vmbus_drv.c b/drivers/staging/hv/vmbus_drv.c new file mode 100644 index 000000000000..0e13d778c003 --- /dev/null +++ b/drivers/staging/hv/vmbus_drv.c @@ -0,0 +1,1105 @@ +/* + * + * 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 "include/logging.h" +#include "include/vmbus.h" + + +/* Defines */ + + +/* FIXME! We need to do this dynamically for PIC and APIC system */ +#define VMBUS_IRQ 0x5 +#define VMBUS_IRQ_VECTOR IRQ5_VECTOR + +/* 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); +static int vmbus_uevent(struct device *device, struct kobj_uevent_env *env); +static void vmbus_msg_dpc(unsigned long data); +static void vmbus_event_dpc(unsigned long data); + +static irqreturn_t vmbus_isr(int irq, void* dev_id); + +static void vmbus_device_release(struct device *device); +static void vmbus_bus_release(struct device *device); + +static struct hv_device *vmbus_child_device_create(GUID type, GUID instance, void* context); +static void vmbus_child_device_destroy(struct hv_device *device_obj); +static int vmbus_child_device_register(struct hv_device *root_device_obj, struct hv_device *child_device_obj); +static void vmbus_child_device_unregister(struct hv_device *child_device_obj); +static void vmbus_child_device_get_info(struct hv_device *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 */ + +/* 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 +}; + +/* The one and only one */ +static struct vmbus_driver_context g_vmbus_drv={ + .bus.name = "vmbus", + .bus.match = vmbus_match, + .bus.shutdown = vmbus_shutdown, + .bus.remove = vmbus_remove, + .bus.probe = vmbus_probe, + .bus.uevent = vmbus_uevent, + .bus.dev_attrs = vmbus_device_attrs, +}; + + +/* 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 +--*/ +static 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 */ + ret = bus_register(&vmbus_drv_ctx->bus); + if (ret) + { + ret = -1; + goto cleanup; + } + + /* Get the interrupt resource */ + ret = request_irq(vmbus_irq, + vmbus_isr, + IRQF_SAMPLE_RANDOM, + vmbus_drv_obj->Base.name, + NULL); + + 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; + } + vector = VMBUS_IRQ_VECTOR; + + 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); */ + dev_set_name(&dev_ctx->device, "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 */ + ret = device_register(&dev_ctx->device); + if (ret) + { + DPRINT_ERR(VMBUS_DRV, "ERROR - Unable to register vmbus root device"); + + free_irq(vmbus_irq, NULL); + bus_unregister(&vmbus_drv_ctx->bus); + + ret = -1; + goto cleanup; + } + + + 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() + +--*/ +static 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 + +--*/ +int vmbus_child_driver_register(struct driver_context* driver_ctx) +{ + VMBUS_DRIVER_OBJECT *vmbus_drv_obj=&g_vmbus_drv.drv_obj; + int ret; + + 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; + + ret = driver_register(&driver_ctx->driver); + + vmbus_drv_obj->GetChannelOffers(); + + DPRINT_EXIT(VMBUS_DRV); + + return ret; +} + +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(struct hv_device *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 struct hv_device *vmbus_child_device_create(GUID type, GUID instance, void* context) +{ + struct device_context *child_device_ctx; + struct hv_device *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(struct hv_device *root_device_obj, struct hv_device *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 atomic_t device_num = ATOMIC_INIT(0); + + DPRINT_ENTER(VMBUS_DRV); + + DPRINT_DBG(VMBUS_DRV, "child device (%p) registering", child_device_ctx); + + /* Make sure we are not registered already */ + + if (strlen(dev_name(&child_device_ctx->device)) != 0) + { + DPRINT_ERR(VMBUS_DRV, "child device (%p) already registered - busid %s", child_device_ctx, dev_name(&child_device_ctx->device)); + + ret = -1; + goto Cleanup; + } + + /* Set the device bus id. Otherwise, device_register()will fail. */ + dev_set_name(&child_device_ctx->device, "vmbus_0_%d", atomic_inc_return(&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)", &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(struct hv_device *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(struct hv_device *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 + +--*/ +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; +} + +/*++ + +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 */ + /* struct hv_driver 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() +--*/ +static void vmbus_probe_failed_cb(struct work_struct *context) +{ + 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)...", dev_name(child_device), child_device, child_device->driver->name, ret); + + INIT_WORK(&device_ctx->probe_failed_work_item, vmbus_probe_failed_cb); + 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 + +--*/ +static irqreturn_t vmbus_isr(int irq, void* dev_id) +{ + 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)); +/* Todo: it is used for loglevel, to be ported to new kernel. */ + + 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(); +/* Todo: it is used for loglevel, to be ported to new kernel. */ + DPRINT_EXIT(VMBUS_DRV); + + return; +} + +module_param(vmbus_irq, int, S_IRUGO); +module_param(vmbus_loglevel, int, S_IRUGO); + +module_init(vmbus_init); +module_exit(vmbus_exit); +/* eof */ |