*/
#include <palacios/vmm.h>
-#include <devices/i440fx.h>
+#include <palacios/vm_guest.h>
+#include <palacios/vmm_dev_mgr.h>
+#include <devices/pci.h>
+
+#include <palacios/vmm_io.h>
+
+
+// We Have to setup some sort of PIC interrupt mapping here....
struct i440_state {
- int foo;
+ struct vm_device * pci;
};
-static int io_read(ushort_t port, void * dst, uint_t length, struct vm_device * dev) {
- PrintError("Unhandled read on port %x\n", port);
+static int io_read(struct guest_info * core, ushort_t port, void * dst, uint_t length, void * priv_data) {
+ PrintError(core->vm_info, core, "Unhandled read on port %x\n", port);
return -1;
}
-static int io_write(ushort_t port, void * src, uint_t length, struct vm_device * dev) {
- PrintError("Unhandled write on port %x\n", port);
+static int io_write(struct guest_info * core, ushort_t port, void * src, uint_t length, void * priv_data) {
+ PrintError(core->vm_info, core, "Unhandled write on port %x\n", port);
return -1;
}
-static int i440_init(struct vm_device * dev) {
- // struct i440_state * state = (struct i440_state *)(dev->private_data);
-
-
- v3_dev_hook_io(dev, 0x00b2,
- &io_read, &io_write);
- v3_dev_hook_io(dev, 0x00b3,
- &io_read, &io_write);
- v3_dev_hook_io(dev, 0x0cf8,
- &io_read, &io_write);
+static int i440_free(struct i440_state * state) {
+ // unregister from PCI
- v3_dev_hook_io(dev, 0x0cf9,
- &io_read, &io_write);
-
-
+ V3_Free(state);
return 0;
}
+static struct v3_device_ops dev_ops = {
+ .free = (int (*)(void *))i440_free,
-static int i440_deinit(struct vm_device * dev) {
- return 0;
-}
-
-static struct vm_device_ops dev_ops = {
- .init = i440_init,
- .deinit = i440_deinit,
- .reset = NULL,
- .start = NULL,
- .stop = NULL,
};
-struct vm_device * v3_create_i440fx(struct vm_device * pci) {
+static int i440_init(struct v3_vm_info * vm, v3_cfg_tree_t * cfg) {
+ struct pci_device * pci_dev = NULL;
+ struct v3_pci_bar bars[6];
+ int i;
struct i440_state * state = NULL;
+ struct vm_device * pci = v3_find_dev(vm, v3_cfg_val(cfg, "bus"));
+ char * dev_id = v3_cfg_val(cfg, "ID");
+ int ret = 0;
+ if (!pci) {
+ PrintError(vm, VCORE_NONE, "could not find PCI Device\n");
+ return -1;
+ }
state = (struct i440_state *)V3_Malloc(sizeof(struct i440_state));
-
- struct vm_device * i440_dev = v3_create_device("i440FX", &dev_ops, state);
- return i440_dev;
+ if (!state) {
+ PrintError(vm, VCORE_NONE, "Cannot allocate state\n");
+ return -1;
+ }
+ state->pci = pci;
+
+ struct vm_device * dev = v3_add_device(vm, dev_id, &dev_ops, state);
+
+ if (dev == NULL) {
+ PrintError(vm, VCORE_NONE, "Could not attach device %s\n", dev_id);
+ V3_Free(state);
+ return -1;
+ }
+
+ for (i = 0; i < 4; i++) {
+ ret |= v3_dev_hook_io(dev, 0x0cf8 + i, &io_read, &io_write);
+ ret |= v3_dev_hook_io(dev, 0x0cfc + i, &io_read, &io_write);
+ }
+
+ /*
+ if (ret != 0) {
+ PrintError(vm, VCORE_NONE, "Error hooking i440FX io ports\n");
+ v3_remove_device(dev);
+ return -1;
+ }
+ */
+
+ for (i = 0; i < 6; i++) {
+ bars[i].type = PCI_BAR_NONE;
+ }
+
+ pci_dev = v3_pci_register_device(state->pci, PCI_STD_DEVICE,
+ 0, 0, 0, "i440FX", bars,
+ NULL, NULL, NULL, NULL, state);
+
+ if (!pci_dev) {
+ v3_remove_device(dev);
+ return -1;
+ }
+
+ pci_dev->config_header.vendor_id = 0x8086;
+ pci_dev->config_header.device_id = 0x1237;
+ pci_dev->config_header.revision = 0x02;
+ pci_dev->config_header.subclass = 0x00; // SubClass: host2pci
+ pci_dev->config_header.class = PCI_CLASS_BRIDGE; // Class: PCI bridge
+
+ pci_dev->config_space[0x72] = 0x02; // SMRAM (?)
+
+ return 0;
}
+
+device_register("i440FX", i440_init);