X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=palacios%2Fsrc%2Fdevices%2Fnvram.c;h=bf450aee744f45901daf97b0f475894708fcc725;hb=2b1f4ef19d766727f873476861c64339c8836a40;hp=fb5b9eb6a4016855a5f857e53ecd5d58b27e078a;hpb=7841dc573457c334a0f3b6e9186d26b1776c400f;p=palacios.releases.git diff --git a/palacios/src/devices/nvram.c b/palacios/src/devices/nvram.c index fb5b9eb..bf450ae 100644 --- a/palacios/src/devices/nvram.c +++ b/palacios/src/devices/nvram.c @@ -4,20 +4,21 @@ extern struct vmm_os_hooks *os_hooks; +extern void SerialPrint(const char *format, ...); #define NVRAM_REG_PORT 0x70 #define NVRAM_DATA_PORT 0x71 -typedef enum {NVRAM_READY,NVRAM_REG_POSTED} nvram_state_t; +typedef enum {NVRAM_READY, NVRAM_REG_POSTED} nvram_state_t; #define NVRAM_REG_MAX 256 // These are borrowed from Bochs, which borrowed from -// Ralf Brown's interupt list +// Ralf Brown's interupt list, and extended #define NVRAM_REG_SEC 0x00 #define NVRAM_REG_SEC_ALARM 0x01 #define NVRAM_REG_MIN 0x02 @@ -34,12 +35,34 @@ typedef enum {NVRAM_READY,NVRAM_REG_POSTED} nvram_state_t; #define NVRAM_REG_STAT_D 0x0d #define NVRAM_REG_DIAGNOSTIC_STATUS 0x0e #define NVRAM_REG_SHUTDOWN_STATUS 0x0f + +#define NVRAM_IBM_HD_DATA 0x12 + +#define NVRAM_REG_FLOPPY_TYPE 0x10 #define NVRAM_REG_EQUIPMENT_BYTE 0x14 + +#define NVRAM_REG_BASE_MEMORY_HIGH 0x16 +#define NVRAM_REG_BASE_MEMORY_LOW 0x15 + +#define NVRAM_REG_EXT_MEMORY_HIGH 0x18 +#define NVRAM_REG_EXT_MEMORY_LOW 0x17 + +#define NVRAM_REG_EXT_MEMORY_2ND_HIGH 0x31 +#define NVRAM_REG_EXT_MEMORY_2ND_LOW 0x30 + +#define NVRAM_REG_BOOTSEQ_OLD 0x2d + +#define NVRAM_REG_AMI_BIG_MEMORY_HIGH 0x35 +#define NVRAM_REG_AMI_BIG_MEMORY_LOW 0x34 + + #define NVRAM_REG_CSUM_HIGH 0x2e #define NVRAM_REG_CSUM_LOW 0x2f #define NVRAM_REG_IBM_CENTURY_BYTE 0x32 #define NVRAM_REG_IBM_PS2_CENTURY_BYTE 0x37 +#define NVRAM_REG_BOOTSEQ_NEW_FIRST 0x3D +#define NVRAM_REG_BOOTSEQ_NEW_SECOND 0x38 struct nvram_internal { @@ -50,53 +73,75 @@ struct nvram_internal { +static int set_nvram_defaults(struct vm_device *dev) +{ + struct nvram_internal * nvram_state = (struct nvram_internal*) dev->private_data; + + // + // 2 1.44 MB floppy drives + // + nvram_state->mem_state[NVRAM_REG_FLOPPY_TYPE]= 0x44; + + // + // For old boot sequence style, do floppy first + // + nvram_state->mem_state[NVRAM_REG_BOOTSEQ_OLD]= 0x10; + +#if 0 + // For new boot sequence style, do floppy, cd, then hd + nvram_state->mem_state[NVRAM_REG_BOOTSEQ_NEW_FIRST]= 0x31; + nvram_state->mem_state[NVRAM_REG_BOOTSEQ_NEW_SECOND]= 0x20; +#endif + + // For new boot sequence style, do cd, hd, floppy + nvram_state->mem_state[NVRAM_REG_BOOTSEQ_NEW_FIRST]= 0x23; + nvram_state->mem_state[NVRAM_REG_BOOTSEQ_NEW_SECOND]= 0x10; + + // Set equipment byte to note 2 floppies, vga display, keyboard,math,floppy + nvram_state->mem_state[NVRAM_REG_EQUIPMENT_BYTE]= 0x4f; -int nvram_reset_device(struct vm_device *dev) -{ - struct nvram_internal *data = (struct nvram_internal *) dev->private_data; - - data->dev_state = NVRAM_READY; - data->thereg=0; - - return 0; + // Set conventional memory to 640K + nvram_state->mem_state[NVRAM_REG_BASE_MEMORY_HIGH]= 0x02; + nvram_state->mem_state[NVRAM_REG_BASE_MEMORY_LOW]= 0x80; -} + // Set extended memory to 15 MB + nvram_state->mem_state[NVRAM_REG_EXT_MEMORY_HIGH]= 0x3C; + nvram_state->mem_state[NVRAM_REG_EXT_MEMORY_LOW]= 0x00; + nvram_state->mem_state[NVRAM_REG_EXT_MEMORY_2ND_HIGH]= 0x3C; + nvram_state->mem_state[NVRAM_REG_EXT_MEMORY_2ND_LOW]= 0x00; -int nvram_init_device(struct vm_device *dev, struct vm_guest *vm) -{ - struct nvram_internal *data = (struct nvram_internal *) dev->private_data; - - memset(data->mem_state,0,NVRAM_REG_MAX); + // Set the extended memory beyond 16 MB to 128-16 MB + // nvram_state->mem_state[NVRAM_REG_AMI_BIG_MEMORY_HIGH]= 0x7; + //nvram_state->mem_state[NVRAM_REG_AMI_BIG_MEMORY_LOW]= 0x00; - nvram_reset_device(dev); + nvram_state->mem_state[NVRAM_REG_AMI_BIG_MEMORY_HIGH]= 0x00; + nvram_state->mem_state[NVRAM_REG_AMI_BIG_MEMORY_LOW]= 0x00; - // hook ports - dev_mgr_hook_io(dev->vm, - dev, - NVRAM_REG_PORT, - DEVICE_EMULATED, - DEVICE_WRITE); - - dev_mgr_hook_io(dev->vm, - dev, - NVRAM_DATA_PORT, - DEVICE_EMULATED, - DEVICE_READWRITE); + + // This is the harddisk type.... Set accordingly... + nvram_state->mem_state[NVRAM_IBM_HD_DATA] = 0x20; return 0; + } -int nvram_deinit_device(struct vm_device *dev) -{ - nvram_reset_device(dev); +int nvram_reset_device(struct vm_device * dev) +{ + struct nvram_internal *data = (struct nvram_internal *) dev->private_data; - dev_mgr_unhook_device(dev->vm,dev); + SerialPrint("nvram: reset device\n"); + + + data->dev_state = NVRAM_READY; + data->thereg=0; + + return 0; -} +} @@ -104,99 +149,119 @@ int nvram_deinit_device(struct vm_device *dev) int nvram_start_device(struct vm_device *dev) { + SerialPrint("nvram: start device\n"); return 0; } int nvram_stop_device(struct vm_device *dev) { + SerialPrint("nvram: stop device\n"); return 0; } -int nvram_read_io_port(ushort_t port_read, - void *address, + +int nvram_write_reg_port(ushort_t port, + void * src, + uint_t length, + struct vm_device * dev) +{ + struct nvram_internal *data = (struct nvram_internal *) dev->private_data; + + memcpy(&(data->thereg), src, 1); + PrintDebug("Writing To NVRAM reg: 0x%x\n", data->thereg); + + + return 1; +} + +int nvram_read_data_port(ushort_t port, + void * dst, uint_t length, - struct vm_device *dev) + struct vm_device * dev) { struct nvram_internal *data = (struct nvram_internal *) dev->private_data; - switch (port_read) { - case NVRAM_REG_PORT: - // nonsense - memset(address,0,length); - break; - case NVRAM_DATA_PORT: - memcpy(address,&(data->mem_state[data->thereg]),1); - break; - default: - //bad - return -1; - } - return 0; + + + memcpy(dst, &(data->mem_state[data->thereg]), 1); + + PrintDebug("nvram_read_data_port(0x%x)=0x%x\n", data->thereg, data->mem_state[data->thereg]); + + return 1; } -int nvram_write_io_port(ushort_t port_written, - void *address, +int nvram_write_data_port(ushort_t port, + void * src, uint_t length, - struct vm_device *dev) + struct vm_device * dev) { struct nvram_internal *data = (struct nvram_internal *) dev->private_data; - switch (port_written) { - case NVRAM_REG_PORT: - memcpy(&(data->thereg),address,1); - break; - case NVRAM_DATA_PORT: - memcpy(&(data->mem_state[data->thereg]),address,1); - break; - default: - //bad - return -1; - } - return 0; + memcpy(&(data->mem_state[data->thereg]), src, 1); + + PrintDebug("nvram_write_data_port(0x%x)=0x%x\n", data->thereg, data->mem_state[data->thereg]); + + return 1; } -int nvram_read_mapped_memory(void *address_read, - void *address, - uint_t length, - struct vm_device *dev) -{ - return -1; + +int nvram_init_device(struct vm_device * dev) { + + struct nvram_internal *data = (struct nvram_internal *) dev->private_data; + + SerialPrint("nvram: init_device\n"); + + memset(data->mem_state, 0, NVRAM_REG_MAX); + + // Would read state here + set_nvram_defaults(dev); + + nvram_reset_device(dev); + + // hook ports + dev_hook_io(dev, NVRAM_REG_PORT, NULL, &nvram_write_reg_port); + dev_hook_io(dev, NVRAM_DATA_PORT, &nvram_read_data_port, &nvram_write_data_port); + + return 0; } -int nvram_write_mapped_memory(void *address_written, - void *address, - uint_t length, - struct vm_device *dev) +int nvram_deinit_device(struct vm_device *dev) { - return -1; + + + dev_unhook_io(dev, NVRAM_REG_PORT); + dev_unhook_io(dev, NVRAM_DATA_PORT); + + nvram_reset_device(dev); + return 0; } -static struct vm_device nvram_template = - { .init_device = nvram_init_device, - .deinit_device = nvram_deinit_device, - .reset_device = nvram_reset_device, - .start_device = nvram_start_device, - .stop_device = nvram_stop_device, - .read_io_port = nvram_read_io_port, - .write_io_port = nvram_write_io_port, - .read_mapped_memory = nvram_read_mapped_memory, - .write_mapped_memory= nvram_write_mapped_memory, - }; -struct vm_device *nvram_create() -{ - struct vm_device *device = os_hooks->malloc(sizeof(struct vm_device)); +static struct vm_device_ops dev_ops = { + .init = nvram_init_device, + .deinit = nvram_deinit_device, + .reset = nvram_reset_device, + .start = nvram_start_device, + .stop = nvram_stop_device, +}; + + + + +struct vm_device *create_nvram() { + struct nvram_internal * nvram_state = os_hooks->malloc(sizeof(struct nvram_internal)+1000); + + SerialPrint("internal at %x\n",nvram_state); - *device = nvram_template; + struct vm_device *device = create_device("NVRAM", &dev_ops, nvram_state); - device->private_data = os_hooks->malloc(sizeof(struct nvram_internal)); return device; }