}
-int v3_init_devices() {
+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 V3_deinit_devices() {
+ v3_free_htable(master_dev_table, 0, 0);
+ return 0;
+}
+
+
int v3_init_dev_mgr(struct v3_vm_info * vm) {
struct vmm_dev_mgr * mgr = &(vm->dev_mgr);
INIT_LIST_HEAD(&(mgr->blk_list));
INIT_LIST_HEAD(&(mgr->net_list));
INIT_LIST_HEAD(&(mgr->char_list));
- INIT_LIST_HEAD(&(mgr->console_list));
+ INIT_LIST_HEAD(&(mgr->cons_list));
mgr->blk_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn);
mgr->net_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn);
mgr->char_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn);
- mgr->console_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn);
+ mgr->cons_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn);
return 0;
}
-int v3_dev_mgr_deinit(struct v3_vm_info * vm) {
- struct vm_device * dev;
+int v3_free_vm_devices(struct v3_vm_info * vm) {
struct vmm_dev_mgr * mgr = &(vm->dev_mgr);
+ struct vm_device * dev;
struct vm_device * tmp;
list_for_each_entry_safe(dev, tmp, &(mgr->dev_list), dev_link) {
- v3_detach_device(dev);
- v3_free_device(dev);
+ v3_remove_device(dev);
}
- v3_free_htable(mgr->blk_table, 0, 0);
- v3_free_htable(mgr->net_table, 0, 0);
- v3_free_htable(mgr->char_table, 0, 0);
- v3_free_htable(mgr->console_table, 0, 0);
-
- v3_free_htable(mgr->dev_table, 0, 0);
-
return 0;
}
-/*
-int v3_init_core_dev_mgr(struct v3_vm_info * vm) {
- struct v3_core_dev_mgr * mgr = &(vm->core_dev_mgr);
+static int free_frontends(struct v3_vm_info * vm, struct vmm_dev_mgr * mgr);
- INIT_LIST_HEAD(&(mgr->dev_list));
- mgr->dev_table = v3_create_htable(0, dev_hash_fn, dev_eq_fn);
+int v3_deinit_dev_mgr(struct v3_vm_info * vm) {
+ struct vmm_dev_mgr * mgr = &(vm->dev_mgr);
+
+ // clear frontend lists
- return 0;
-}
+ free_frontends(vm, mgr);
-int v3_core_dev_mgr_deinit(struct v3_vm_info * vm) {
- struct vm_device * dev;
- struct v3_core_dev_mgr * mgr = &(vm->core_dev_mgr);
- struct vm_device * tmp;
- list_for_each_entry_safe(dev, tmp, &(mgr->dev_list), dev_link) {
- v3_detach_device(dev);
- v3_free_device(dev);
- }
- // TODO: Clear hash tables
+ v3_free_htable(mgr->dev_table, 0, 0);
+ return 0;
}
-*/
+
int v3_create_device(struct v3_vm_info * vm, const char * dev_name, v3_cfg_tree_t * cfg) {
}
-void v3_free_device(struct vm_device * dev) {
- V3_Free(dev);
-}
-
struct vm_device * v3_find_dev(struct v3_vm_info * vm, const char * dev_name) {
/* The remaining functions are called by the devices themselves */
/****************************************************************/
-/* IO HOOKS */
+typedef enum {DEV_IO_HOOK, DEV_MSR_HOOK, DEV_CPUID_HOOK, DEV_MEM_HOOK, DEV_HCALL_HOOK} dev_rsrc_type_t;
+
+struct dev_rsrc {
+ dev_rsrc_type_t type;
+ uint64_t rsrc;
+
+ struct list_head node;
+};
+
+
+
+static int add_resource(struct vm_device * dev, dev_rsrc_type_t type, uint64_t rsrc_id) {
+ struct dev_rsrc * resource = NULL;
+
+ resource = V3_Malloc(sizeof(struct dev_rsrc));
+
+ if (resource == NULL) {
+ PrintError("Error: Could not allocate device resource\n");
+ return -1;
+ }
+
+ resource->rsrc = rsrc_id;
+ resource->type = type;
+
+ list_add(&(resource->node), &(dev->res_hooks));
+ return 0;
+}
+
+static int free_resource(struct vm_device * dev, dev_rsrc_type_t type, uint64_t rsrc_id) {
+ struct dev_rsrc * resource = NULL;
+ struct dev_rsrc * tmp;
+
+ list_for_each_entry_safe(resource, tmp, &(dev->res_hooks), node) {
+ if ((resource->type == type) &&
+ (resource->rsrc == rsrc_id)) {
+
+ list_del(&(resource->node));
+ V3_Free(resource);
+
+ return 0;
+ }
+ }
+
+ return -1;
+}
+
+
int v3_dev_hook_io(struct vm_device * dev, uint16_t port,
- int (*read)(struct guest_info * core, uint16_t port, void * dst, uint_t length, struct vm_device * dev),
- int (*write)(struct guest_info * core, uint16_t port, void * src, uint_t length, struct vm_device * dev)) {
- return v3_hook_io_port(dev->vm, port,
- (int (*)(struct guest_info * core, ushort_t, void *, uint_t, void *))read,
- (int (*)(struct guest_info * core, ushort_t, void *, uint_t, void *))write,
- (void *)dev);
+ int (*read)(struct guest_info * core, uint16_t port, void * dst, uint_t length, void * priv_data),
+ int (*write)(struct guest_info * core, uint16_t port, void * src, uint_t length, void * priv_data)) {
+ int ret = 0;
+
+ ret = v3_hook_io_port(dev->vm, port,
+ (int (*)(struct guest_info * core, uint16_t, void *, uint_t, void *))read,
+ (int (*)(struct guest_info * core, uint16_t, void *, uint_t, void *))write,
+ (void *)dev->private_data);
+
+ if (ret == -1) {
+ return -1;
+ }
+
+ if (add_resource(dev, DEV_IO_HOOK, port) == -1) {
+ v3_unhook_io_port(dev->vm, port);
+ PrintError("Could not allocate io hook dev state\n");
+ return -1;
+ }
+
+ return 0;
}
int v3_dev_unhook_io(struct vm_device * dev, uint16_t port) {
- return v3_unhook_io_port(dev->vm, port);
+ if (free_resource(dev, DEV_IO_HOOK, port) == 0) {
+ return v3_unhook_io_port(dev->vm, port);
+ }
+
+ return -1;
+}
+
+
+int v3_dev_hook_msr(struct vm_device * dev, uint32_t msr,
+ int (*read)(struct guest_info * core, uint32_t msr, struct v3_msr * dst, void * priv_data),
+ int (*write)(struct guest_info * core, uint32_t msr, struct v3_msr src, void * priv_data)) {
+ int ret = 0;
+
+ ret = v3_hook_msr(dev->vm, msr, read, write, dev->private_data);
+
+ if (ret == -1) {
+ return -1;
+ }
+
+ if (add_resource(dev, DEV_MSR_HOOK, msr) == -1) {
+ v3_unhook_msr(dev->vm, msr);
+ return -1;
+ }
+
+ return 0;
+}
+
+int v3_dev_unhook_msr(struct vm_device * dev, uint32_t msr) {
+ if (free_resource(dev, DEV_MSR_HOOK, msr) == 0) {
+ return v3_unhook_msr(dev->vm, msr);
+ }
+
+ return -1;
}
-int v3_detach_device(struct vm_device * dev) {
+
+int v3_remove_device(struct vm_device * dev) {
struct vmm_dev_mgr * mgr = &(dev->vm->dev_mgr);
+ struct dev_rsrc * resource = NULL;
+ struct dev_rsrc * tmp;
+
+ list_for_each_entry_safe(resource, tmp, &(dev->res_hooks), node) {
+ if (resource->type == DEV_IO_HOOK) {
+ v3_unhook_io_port(dev->vm, (uint16_t)(resource->rsrc));
+ } else if (resource->type == DEV_MSR_HOOK) {
+ v3_unhook_msr(dev->vm, (uint32_t)(resource->rsrc));
+ }
+
+ list_del(&(resource->node));
+ V3_Free(resource);
+ }
if (dev->ops->free) {
- dev->ops->free(dev);
+ dev->ops->free(dev->private_data);
} else {
PrintError("Error: %s free() not implemented\n", dev->name);
}
dev->vm = NULL;
+ V3_Free(dev);
return -1;
}
-struct vm_device * v3_allocate_device(char * name,
- struct v3_device_ops * ops,
- void * private_data) {
+struct vm_device * v3_add_device(struct v3_vm_info * vm,
+ char * name,
+ struct v3_device_ops * ops,
+ void * private_data) {
+ struct vmm_dev_mgr * mgr = &(vm->dev_mgr);
struct vm_device * dev = NULL;
- dev = (struct vm_device*)V3_Malloc(sizeof(struct vm_device));
+ dev = (struct vm_device *)V3_Malloc(sizeof(struct vm_device));
+
+ if (dev == NULL) {
+ return NULL;
+ }
+
+ INIT_LIST_HEAD(&(dev->res_hooks));
strncpy(dev->name, name, 32);
dev->ops = ops;
dev->private_data = private_data;
- dev->vm = NULL;
-
- return dev;
-}
-
-
-int v3_attach_device(struct v3_vm_info * vm, struct vm_device * dev ) {
- struct vmm_dev_mgr * mgr = &(vm->dev_mgr);
-
dev->vm = vm;
list_add(&(dev->dev_link), &(mgr->dev_list));
mgr->num_devs++;
-
v3_htable_insert(mgr->dev_table, (addr_t)(dev->name), (addr_t)dev);
- return 0;
+ return dev;
}
-
void v3_print_dev_mgr(struct v3_vm_info * vm) {
struct vmm_dev_mgr * mgr = &(vm->dev_mgr);
struct vm_device * dev;
}
+struct cons_frontend {
+ int (*connect)(struct v3_vm_info * vm,
+ void * frontend_data,
+ struct v3_dev_console_ops * ops,
+ v3_cfg_tree_t * cfg,
+ void * priv_data);
+
+
+ struct list_head cons_node;
+
+ void * priv_data;
+};
+
+int v3_dev_add_console_frontend(struct v3_vm_info * vm,
+ char * name,
+ int (*connect)(struct v3_vm_info * vm,
+ void * frontend_data,
+ struct v3_dev_console_ops * ops,
+ v3_cfg_tree_t * cfg,
+ void * private_data),
+ void * priv_data)
+{
+ struct cons_frontend * frontend = NULL;
+
+ frontend = (struct cons_frontend *)V3_Malloc(sizeof(struct cons_frontend));
+ memset(frontend, 0, sizeof(struct cons_frontend));
+
+ frontend->connect = connect;
+ frontend->priv_data = priv_data;
+
+ list_add(&(frontend->cons_node), &(vm->dev_mgr.cons_list));
+ v3_htable_insert(vm->dev_mgr.cons_table, (addr_t)(name), (addr_t)frontend);
+
+ return 0;
+}
+
+
+int v3_dev_connect_console(struct v3_vm_info * vm,
+ char * frontend_name,
+ struct v3_dev_console_ops * ops,
+ v3_cfg_tree_t * cfg,
+ void * private_data)
+{
+ struct cons_frontend * frontend = NULL;
+
+ frontend = (struct cons_frontend *)v3_htable_search(vm->dev_mgr.cons_table,
+ (addr_t)frontend_name);
+
+ if (frontend == NULL) {
+ PrintError("Could not find frontend console device %s\n", frontend_name);
+ return 0;
+ }
+
+ if (frontend->connect(vm, frontend->priv_data, ops, cfg, private_data) == -1) {
+ PrintError("Error connecting to console frontend %s\n", frontend_name);
+ return -1;
+ }
+
+ return 0;
+}
+
struct char_frontend {
int (*connect)(struct v3_vm_info * vm,
void * frontend_data,
void * priv_data;
};
-
-
int v3_dev_add_char_frontend(struct v3_vm_info * vm,
char * name,
int (*connect)(struct v3_vm_info * vm,
return 0;
}
+
+
+static int free_frontends(struct v3_vm_info * vm, struct vmm_dev_mgr * mgr) {
+ struct char_frontend * chr = NULL;
+ struct char_frontend * tmp_chr = NULL;
+ struct cons_frontend * cons = NULL;
+ struct cons_frontend * tmp_cons = NULL;
+ struct net_frontend * net = NULL;
+ struct net_frontend * tmp_net = NULL;
+ struct blk_frontend * blk = NULL;
+ struct blk_frontend * tmp_blk = NULL;
+
+
+
+ list_for_each_entry_safe(chr, tmp_chr, &(mgr->char_list), char_node) {
+ list_del(&(chr->char_node));
+ V3_Free(chr);
+ }
+
+ list_for_each_entry_safe(cons, tmp_cons, &(mgr->cons_list), cons_node) {
+ list_del(&(cons->cons_node));
+ V3_Free(cons);
+ }
+
+ list_for_each_entry_safe(net, tmp_net, &(mgr->net_list), net_node) {
+ list_del(&(net->net_node));
+ V3_Free(net);
+ }
+
+ list_for_each_entry_safe(blk, tmp_blk, &(mgr->blk_list), blk_node) {
+ list_del(&(blk->blk_node));
+ V3_Free(blk);
+ }
+
+ v3_free_htable(mgr->blk_table, 0, 0);
+ v3_free_htable(mgr->net_table, 0, 0);
+ v3_free_htable(mgr->char_table, 0, 0);
+ v3_free_htable(mgr->cons_table, 0, 0);
+
+
+ return 0;
+}