mirrors
/
linux-stable
mirror of https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
1
0
Fork 0
Code Issues Releases Wiki Activity
linux-stable/drivers/staging/hv/vmbus_drv.c

1229 lines
34 KiB
C
Raw Normal View History

Staging: hv: add the Hyper-V virtual bus This is the virtual bus that all of the Linux Hyper-V drivers use. Signed-off-by: Hank Janssen <hjanssen@microsoft.com> Signed-off-by: Haiyang Zhang <haiyangz@microsoft.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2009-07-13 23:02:34 +00:00
/*
*
* 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