X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=palacios%2Fsrc%2Fpalacios%2Fvmm_dev_mgr.c;h=c21295846b26801e536a4321430a1d7dd84d6a79;hb=82b8b87c344fcd1eab22e3f3be5ad54cbb3f8f68;hp=81f053c3b0e0d3a54cbe6b848728d8105084f541;hpb=7841dc573457c334a0f3b6e9186d26b1776c400f;p=palacios.git diff --git a/palacios/src/palacios/vmm_dev_mgr.c b/palacios/src/palacios/vmm_dev_mgr.c index 81f053c..c212958 100644 --- a/palacios/src/palacios/vmm_dev_mgr.c +++ b/palacios/src/palacios/vmm_dev_mgr.c @@ -1,295 +1,243 @@ +/* + * This file is part of the Palacios Virtual Machine Monitor developed + * by the V3VEE Project with funding from the United States National + * Science Foundation and the Department of Energy. + * + * The V3VEE Project is a joint project between Northwestern University + * and the University of New Mexico. You can find out more at + * http://www.v3vee.org + * + * Copyright (c) 2008, Jack Lange + * Copyright (c) 2008, The V3VEE Project + * All rights reserved. + * + * Author: Jack Lange + * + * This is free software. You are permitted to use, + * redistribute, and modify it as specified in the file "V3VEE_LICENSE". + */ -#include #include #include #include +#include -extern struct vmm_os_hooks *os_hooks; -#ifndef NULL -#define NULL 0 +#ifndef CONFIG_DEBUG_DEV_MGR +#undef PrintDebug +#define PrintDebug(fmt, args...) #endif -int dev_mgr_init(struct vmm_dev_mgr *mgr, struct guest_info *vm) -{ - mgr->vm=vm; - mgr->dev_list=NULL; - mgr->num_devices=0; - return 0; + +static struct hashtable * master_dev_table = NULL; + +static uint_t dev_hash_fn(addr_t key) { + char * name = (char *)key; + return v3_hash_buffer((uchar_t *)name, strlen(name)); +} + +static int dev_eq_fn(addr_t key1, addr_t key2) { + char * name1 = (char *)key1; + char * name2 = (char *)key2; + + return (strcmp(name1, name2) == 0); } -int dev_mgr_deinit(struct vmm_dev_mgr *mgr) -{ - int rc; +int v3_init_devices() { + extern struct v3_device_info __start__v3_devices[]; + extern struct v3_device_info __stop__v3_devices[]; + struct v3_device_info * tmp_dev = __start__v3_devices; + int i = 0; - while (mgr->dev_list) { - rc=dev_mgr_detach_device(mgr->vm,mgr->dev_list); - if (rc) { - // Bad bad bad +#ifdef CONFIG_DEBUG_DEV_MGR + { + int num_devices = (__stop__v3_devices - __start__v3_devices) / sizeof(struct v3_device_info); + PrintDebug("%d Virtual devices registered with Palacios\n", num_devices); } - } - return 0; -} +#endif -int dev_mgr_attach_device(struct guest_info *vm, struct vm_device *device) -{ - struct vmm_dev_mgr *mgr= &(vm->dev_mgr); - - if (device->io_hooks || device->mem_hooks) { - return -1; - } - - device->next = mgr->dev_list; - device->prev = 0; - if (device->next) { - device->next->prev = device; - } - mgr->dev_list = device; - - device->vm=vm; - - return 0; + PrintDebug("Start addres=%p, Stop address=%p\n", __start__v3_devices, __stop__v3_devices); + + master_dev_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn); + + + + while (tmp_dev != __stop__v3_devices) { + PrintDebug("Device: %s\n", tmp_dev->name); + + if (v3_htable_search(master_dev_table, (addr_t)(tmp_dev->name))) { + PrintError("Multiple instance of device (%s)\n", tmp_dev->name); + return -1; + } + + if (v3_htable_insert(master_dev_table, + (addr_t)(tmp_dev->name), + (addr_t)(tmp_dev->init)) == 0) { + PrintError("Could not add device %s to master list\n", tmp_dev->name); + return -1; + } + + tmp_dev = &(__start__v3_devices[++i]); + } + + + return 0; } -int dev_mgr_detach_device(struct guest_info *vm, struct vm_device *device) -{ - if (device->prev==0) { - vm->dev_mgr.dev_list = device->next; - } else { - device->prev->next = device->next; - } - if (device->next) { - device->next->prev=device->prev; - } - - // avoid interrupts here - - device->deinit_device(device); - - device->vm=NULL; - return 0; + +int v3_init_dev_mgr(struct guest_info * info) { + struct vmm_dev_mgr * mgr = &(info->dev_mgr); + + INIT_LIST_HEAD(&(mgr->dev_list)); + mgr->num_devs = 0; + + mgr->dev_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn); + + return 0; } -#define INSERT_FRONT(listhead,item) \ - do { \ - if (!(listhead)) { \ - (listhead)=(item); \ - (item)->prev=NULL; \ - (item)->next=NULL; \ - } else { \ - (item)->prev=NULL; \ - (item)->next=(listhead); \ - if ((listhead)->next) { \ - (listhead)->next->prev=(item); \ - } \ - (listhead)=(item); \ - } \ - } while (0) - -#define DELETE(listhead,item) \ - do { \ - if ((item)->prev) { \ - (item)->prev->next=(item)->next; \ - } else { \ - (listhead)=(item)->next; \ - } \ - if ((item)->next) { \ - (item)->next->prev=(item)->prev; \ - } \ - } while (0) - +int v3_dev_mgr_deinit(struct guest_info * info) { + struct vm_device * dev; + struct vmm_dev_mgr * mgr = &(info->dev_mgr); + struct vm_device * tmp; - - -int dev_mgr_hook_io(struct guest_info *vm, - struct vm_device *device, - ushort_t portno, - enum access_control control, - enum access_type atype) -{ - struct vm_device_io_hook *hook = os_hooks->malloc(sizeof(struct vm_device_io_hook)); - - if (!hook) { - return -1; - } - - int (*read)(ushort_t, void *, uint_t, void *) = NULL; - int (*write)(ushort_t, void *, uint_t, void *) = NULL; - - switch (control) { - case DEVICE_EMULATED: - switch (atype) { - case DEVICE_READ: - read = (int (*)(ushort_t, void *,uint_t, void *)) (device->read_io_port); - break; - case DEVICE_WRITE: - write = (int (*)(ushort_t, void *, uint_t, void *)) (device->write_io_port); - break; - case DEVICE_READWRITE: - read = (int (*)(ushort_t, void *, uint_t, void *)) (device->read_io_port); - write = (int (*)(ushort_t, void *, uint_t, void *)) (device->write_io_port); - break; + list_for_each_entry_safe(dev, tmp, &(mgr->dev_list), dev_link) { + v3_detach_device(dev); + v3_free_device(dev); } - break; - case DEVICE_PASSTHROUGH: - read=write=NULL; - break; - } - - hook_io_port(&(vm->io_map), - portno, - read, - write, - device); - - hook->control=control; - hook->atype=atype; - hook->guest_port = portno; - - INSERT_FRONT(device->io_hooks,hook); - - return 0; + + return 0; } -int dev_mgr_unhook_io(struct guest_info *vm, - struct vm_device *device, - ushort_t portno) -{ - struct vm_device_io_hook *hook = device->io_hooks; - while (hook) { - if (hook->guest_port==portno) { - DELETE(device->io_hooks,hook); - break; +int v3_create_device(struct guest_info * info, const char * dev_name, void * cfg_data) { + int (*dev_init)(struct guest_info * info, void * cfg_data); + + dev_init = (void *)v3_htable_search(master_dev_table, (addr_t)dev_name); + + if (dev_init == NULL) { + PrintError("Could not find device %s in master device table\n", dev_name); + return -1; } - } - if (!hook) { - // Very bad - unhooking something that doesn't exist! - return -1; - } - return unhook_io_port(&(vm->io_map), - portno); + if (dev_init(info, cfg_data) == -1) { + PrintError("Could not initialize Device %s\n", dev_name); + return -1; + } + + return 0; } +void v3_free_device(struct vm_device * dev) { + V3_Free(dev); +} -int dev_mgr_hook_mem(struct guest_info *vm, - struct vm_device *device, - void *guest_physical_address_start, - void *guest_physical_address_end, - enum access_control control, - enum access_type atype) -{ - struct vm_device_mem_hook *hook = os_hooks->malloc(sizeof(struct vm_device_mem_hook)); - - if (!hook) { - return -1; - } - - int (*read)(ushort_t, void *, uint_t, void *) = NULL; - int (*write)(ushort_t, void *, uint_t, void *) = NULL; - - switch (control) { - case DEVICE_EMULATED: - switch (atype) { - case DEVICE_READ: - read = (int (*)(ushort_t, void *, uint_t, void *))(device->read_mapped_memory); - break; - case DEVICE_WRITE: - write = (int (*)(ushort_t, void *, uint_t, void *))(device->write_mapped_memory); - break; - case DEVICE_READWRITE: - read = (int (*)(ushort_t, void *, uint_t, void *))(device->read_mapped_memory); - write = (int (*)(ushort_t, void *, uint_t, void *))(device->write_mapped_memory); - break; - } - break; - case DEVICE_PASSTHROUGH: - read=write=NULL; - break; - } - - /* not implemented yet - hook_memory(vm->mem_map, - guest_physical_address_start, - guest_physical_address_end, - read, - write, - device); +struct vm_device * v3_find_dev(struct guest_info * info, const char * dev_name) { + struct vmm_dev_mgr * mgr = &(info->dev_mgr); + + return (struct vm_device *)v3_htable_search(mgr->dev_table, (addr_t)dev_name); +} - */ - return -1; // remove when hook_memory works +/****************************************************************/ +/* The remaining functions are called by the devices themselves */ +/****************************************************************/ - hook->control=control; - hook->atype=atype; - hook->guest_physical_start = guest_physical_address_start; - hook->guest_physical_end = guest_physical_address_end; +/* IO HOOKS */ +int v3_dev_hook_io(struct vm_device * dev, uint16_t port, + int (*read)(uint16_t port, void * dst, uint_t length, struct vm_device * dev), + int (*write)(uint16_t port, void * src, uint_t length, struct vm_device * dev)) { + return v3_hook_io_port(dev->vm, port, + (int (*)(ushort_t, void *, uint_t, void *))read, + (int (*)(ushort_t, void *, uint_t, void *))write, + (void *)dev); +} - - INSERT_FRONT(device->mem_hooks,hook); - return 0; - +int v3_dev_unhook_io(struct vm_device * dev, uint16_t port) { + return v3_unhook_io_port(dev->vm, port); } -int dev_mgr_unhook_mem(struct guest_info *vm, - struct vm_device *device, - void *guest_physical_start, - void *guest_physical_end) -{ - struct vm_device_mem_hook *hook = device->mem_hooks; - while (hook) { - if (hook->guest_physical_start==guest_physical_start && - hook->guest_physical_end==guest_physical_end) { - DELETE(device->mem_hooks,hook); - break; - } - } +int v3_detach_device(struct vm_device * dev) { + struct vmm_dev_mgr * mgr = &(dev->vm->dev_mgr); + + dev->ops->free(dev); + + list_del(&(dev->dev_link)); + mgr->num_devs--; + + dev->vm = NULL; - if (!hook) { - // Very bad - unhooking something that doesn't exist! return -1; - } +} + +struct vm_device * v3_allocate_device(char * name, + struct v3_device_ops * ops, + void * private_data) { + struct vm_device * dev = NULL; - /* not implemented yet - return unhook_mem_port(vm->mem_map, - guest_physical_start, - guest_physical_end) ; + dev = (struct vm_device*)V3_Malloc(sizeof(struct vm_device)); - */ - return -1; + strncpy(dev->name, name, 32); + dev->ops = ops; + dev->private_data = private_data; + + dev->vm = NULL; + + return dev; } -int dev_mgr_unhook_device(struct guest_info *vm, - struct vm_device *device) -{ - struct vm_device_io_hook *iohook=device->io_hooks; - struct vm_device_mem_hook *memhook=device->mem_hooks; +int v3_attach_device(struct guest_info * vm, struct vm_device * dev ) { + struct vmm_dev_mgr * mgr = &(vm->dev_mgr); - while (iohook) { - if (dev_mgr_unhook_io(vm,device,iohook->guest_port)) { - return -1; - } - } + dev->vm = vm; + + list_add(&(dev->dev_link), &(mgr->dev_list)); + mgr->num_devs++; - while (memhook) { - if (dev_mgr_unhook_mem(vm,device,memhook->guest_physical_start, memhook->guest_physical_end)) { - return -1; + + v3_htable_insert(mgr->dev_table, (addr_t)(dev->name), (addr_t)dev); + + return 0; +} + + +#ifdef CONFIG_DEBUG_DEV_MGR + +void PrintDebugDevMgr(struct guest_info * info) { + struct vmm_dev_mgr * mgr = &(info->dev_mgr); + struct vm_device * dev; + + PrintDebug("%d devices registered with manager\n", mgr->num_devs); + + list_for_each_entry(dev, &(mgr->dev_list), dev_link) { + PrintDebugDev(dev); + PrintDebug("next..\n"); } - } - return 0; + return; } + +void PrintDebugDev(struct vm_device * dev) { + PrintDebug("Device: %s\n", dev->name); +} + + + + +#else +void PrintDebugDevMgr(struct guest_info * info) {} +void PrintDebugDev(struct vm_device * dev) {} +#endif