| /* |
| * |
| * 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 "osd.h" |
| #include "include/logging.h" |
| #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(struct hv_guid *type, struct hv_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(struct hv_guid)); |
| memcpy(&dev_ctx->device_id, &dev_ctx->device_obj.deviceInstance, sizeof(struct hv_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(struct hv_guid *type, |
| struct hv_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(struct hv_guid)); |
| memcpy(&child_device_obj->deviceInstance, &instance, sizeof(struct hv_guid)); |
| |
| memcpy(&child_device_ctx->class_id, &type, sizeof(struct hv_guid)); |
| memcpy(&child_device_ctx->device_id, &instance, sizeof(struct hv_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(struct hv_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 */ |