From: Jack Lange <jarusl@cs.northwestern.edu>
Date: Mon, 16 Mar 2009 18:07:00 +0000 (-0500)
Subject: added support for bar updates in io write handler
X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?p=palacios.git;a=commitdiff_plain;h=f95fab77fae701c452fff93326d1cc2797d16b35

added support for bar updates in io write handler
---

diff --git a/palacios/include/devices/pci.h b/palacios/include/devices/pci.h
index 68ca19b..23f459c 100644
--- a/palacios/include/devices/pci.h
+++ b/palacios/include/devices/pci.h
@@ -65,6 +65,9 @@ struct pci_device {
     int (*config_update)(struct pci_device * pci_dev, uint_t reg_num, int length);
 
 
+    int ext_rom_update_flag;
+    int bar_update_flag;
+
     void * priv_data;
 };
 
diff --git a/palacios/src/devices/pci.c b/palacios/src/devices/pci.c
index 23be4f6..e86af94 100644
--- a/palacios/src/devices/pci.c
+++ b/palacios/src/devices/pci.c
@@ -333,7 +333,7 @@ static inline int is_cfg_reg_writable(uchar_t header_type, int reg_num) {
 
 
 static int data_port_write(ushort_t port, void * src, uint_t length, struct vm_device * vmdev) {
-    struct pci_internal * pci_state = (struct pci_internal *)vmdev->private_data;;
+    struct pci_internal * pci_state = (struct pci_internal *)vmdev->private_data;
     struct pci_device * pci_dev = NULL;
     uint_t reg_num = pci_state->addr_reg.reg_num + (port & 0x3);
     int i;
@@ -355,15 +355,50 @@ static int data_port_write(ushort_t port, void * src, uint_t length, struct vm_d
     
 
     for (i = 0; i < length; i++) {
-	if (is_cfg_reg_writable(pci_dev->config_header.header_type, reg_num)) {
-	    pci_dev->config_space[reg_num + i] = *((uint8_t *)src + i);
+	uint_t cur_reg = reg_num + i;
+	
+	if (is_cfg_reg_writable(pci_dev->config_header.header_type, cur_reg)) {
+	    pci_dev->config_space[cur_reg] = *((uint8_t *)src + i);
+
+	    if ((cur_reg >= 0x10) && (cur_reg < 0x28)) {
+		// BAR Reg
+		int bar_reg = (cur_reg & ~0x3) - 0x10;
+
+		if (pci_dev->bar[bar_reg].bar_update) {
+		    pci_dev->bar_update_flag = 1;		
+		    pci_dev->bar[bar_reg].updated = 1;
+		}
+	    } else if ((cur_reg >= 0x30) && (cur_reg < 0x34)) {
+		pci_dev->ext_rom_updated = 1;
+	    } else if ((cur_reg == 0x04) || (cur_reg == 0x05)) {
+		// COMMAND update
+	    } else if (cur_reg == 0x0f) {
+		// BIST update
+	    }
 	}
     }
 
     if (pci_dev->config_update) {
 	pci_dev->config_update(pci_dev, reg_num, length);
     }
-    
+
+    // Scan for BAR updated
+    if (pci_dev->bar_update_flag) {
+	for (i = 0; i < 6; i++) {
+	    if ((pci_dev->bar[i].updated) && (pci_dev->bar[i].bar_update)) {
+		pci_dev->bar[i].bar_update(pci_dev, i);
+	    }
+	    pci_dev->bar[i].updated = 0;
+	}
+	pci_dev->bar_update_flag = 0;
+    }
+
+    if ((pci_dev->ext_rom_update_flag) && (pci_dev->ext_rom_update)) {
+	pci_dev->ext_rom_update(pci_dev);
+	pci_dev->ext_rom_update_flag = 0;
+    }
+
+
     return length;
 }
 
@@ -404,7 +439,7 @@ static int pci_deinit_device(struct vm_device * dev) {
 
 static int init_i440fx(struct vm_device * dev) {
     struct pci_device * pci_dev = v3_pci_register_device(dev, 0, "i440FX", 0, 
-							 NULL, NULL);
+							 NULL, NULL, NULL);
     
     if (!pci_dev) {
 	return -1;
@@ -453,6 +488,8 @@ static int pci_init_device(struct vm_device * dev) {
 	PrintError("Could not intialize i440fx\n");
 	return -1;
     }
+
+    PrintDebug("Sizeof config header=%d\n", sizeof(struct pci_config_header));
     
     for (i = 0; i < 4; i++) {
 	v3_dev_hook_io(dev, CONFIG_ADDR_PORT + i, &addr_port_read, &addr_port_write);
@@ -492,6 +529,7 @@ struct pci_device * v3_pci_register_device(struct vm_device * pci,
 					   const char * name,
 					   int dev_num,
 					   int (*config_update)(struct pci_device * pci_dev, uint_t reg_num, int length),
+					   int (*bar_update)(struct pci_device * pci_dev, uint_t bar),
 					   void * private_data) {
 
     struct pci_internal * pci_state = (struct pci_internal *)pci->private_data;
@@ -532,7 +570,9 @@ struct pci_device * v3_pci_register_device(struct vm_device * pci,
     strncpy(pci_dev->name, name, sizeof(pci_dev->name));
     pci_dev->vm_dev = pci;
 
+    // register update callbacks
     pci_dev->config_update = config_update;
+    pci_dev->bar_update = bar_update;
 
     pci_dev->priv_data = private_data;