#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
// Interrupt associated VM, if needed
if (statc->irq) {
PrintDebug("nvram: injecting interrupt\n");
- dev->vm->vm_ops.raise_irq(dev->vm, NVRAM_RTC_IRQ);
+ v3_raise_irq(dev->vm, NVRAM_RTC_IRQ);
}
}
-int handle_timer_event(struct guest_info * info,
+static int handle_timer_event(struct guest_info * info,
struct v3_timer_event * evt,
void * priv_data) {
return 0;
}
-static int set_nvram_defaults(struct vm_device * dev) {
+
+
+static void set_memory_size(struct nvram_internal * nvram, addr_t bytes) {
+ // 1. Conventional Mem: 0-640k in K
+ // 2. Extended Mem: 0-16MB in K
+ // 3. Big Mem: 0-4G in 64K
+
+ if (bytes > 640 * 1024) {
+ nvram->mem_state[NVRAM_REG_BASE_MEMORY_HIGH] = 0x02;
+ nvram->mem_state[NVRAM_REG_BASE_MEMORY_LOW] = 0x80;
+ } else {
+ uint16_t memk = bytes * 1024;
+ nvram->mem_state[NVRAM_REG_BASE_MEMORY_HIGH] = (memk >> 8) & 0x00ff;
+ nvram->mem_state[NVRAM_REG_BASE_MEMORY_LOW] = memk & 0x00ff;
+
+ return;
+ }
+
+ if (bytes > (16 * 1024 * 1024)) {
+ // Set extended memory to 15 MB
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_HIGH] = 0x3C;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_LOW] = 0x00;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_2ND_HIGH]= 0x3C;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_2ND_LOW]= 0x00;
+ } else {
+ uint16_t memk = bytes * 1024;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_HIGH] = (memk >> 8) & 0x00ff;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_LOW] = memk & 0x00ff;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_2ND_HIGH]= (memk >> 8) & 0x00ff;
+ nvram->mem_state[NVRAM_REG_EXT_MEMORY_2ND_LOW]= memk & 0x00ff;
+
+ return;
+ }
+
+ {
+ // Set the extended memory beyond 16 MB in 64k chunks
+ uint16_t mem_chunks = bytes * (1024 / 64);
+ nvram->mem_state[NVRAM_REG_AMI_BIG_MEMORY_HIGH] = (mem_chunks >> 8) & 0x00ff;
+ nvram->mem_state[NVRAM_REG_AMI_BIG_MEMORY_LOW] = mem_chunks & 0x00ff;
+ }
+
+ return;
+}
+
+static int init_nvram_state(struct vm_device * dev) {
+ struct guest_info * info = dev->vm;
struct nvram_internal * nvram_state = (struct nvram_internal *)dev->private_data;
+
+ /* TODO:
+ * The amount of ram in the system is stored in info->mem_size
+ * We need to reflect that value correctly here
+ */
+ PrintError("TODO: Set the nvram memory register to reflect info->mem_size (%p)\n", (void *)(info->mem_size));
+
+
+ memset(nvram_state->mem_state, 0, NVRAM_REG_MAX);
+
//
// 2 1.44 MB floppy drives
// 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;
- //nvram_state->mem_state[NVRAM_REG_EQUIPMENT_BYTE] = 0xf;
-
- // 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;
-
- // 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_state->mem_state[NVRAM_REG_AMI_BIG_MEMORY_HIGH]= 0x00;
- //nvram_state->mem_state[NVRAM_REG_AMI_BIG_MEMORY_LOW]= 0x00;
-
+ // nvram_state->mem_state[NVRAM_REG_EQUIPMENT_BYTE] = 0xf;
+
// This is the harddisk type.... Set accordingly...
nvram_state->mem_state[NVRAM_IBM_HD_DATA] = 0x20;
nvram_state->us = 0;
nvram_state->pus = 0;
+ set_memory_size(nvram_state, dev->vm->mem_size);
+
+ nvram_state->dev_state = NVRAM_READY;
+ nvram_state->thereg = 0;
+
return 0;
}
-int nvram_reset_device(struct vm_device * dev) {
- struct nvram_internal * data = (struct nvram_internal *) dev->private_data;
-
- PrintDebug("nvram: reset device\n");
-
- data->dev_state = NVRAM_READY;
- data->thereg = 0;
-
+
+
+static int nvram_reset_device(struct vm_device * dev) {
+
return 0;
}
-int nvram_start_device(struct vm_device * dev) {
+static int nvram_start_device(struct vm_device * dev) {
PrintDebug("nvram: start device\n");
return 0;
}
-int nvram_stop_device(struct vm_device * dev) {
+static int nvram_stop_device(struct vm_device * dev) {
PrintDebug("nvram: stop device\n");
return 0;
}
-int nvram_write_reg_port(ushort_t port,
- void * src,
- uint_t length,
- struct vm_device * dev) {
+static 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);
return 1;
}
-int nvram_read_data_port(ushort_t port,
- void * dst,
- uint_t length,
- struct vm_device * dev) {
+static int nvram_read_data_port(ushort_t port,
+ void * dst,
+ uint_t length,
+ struct vm_device * dev) {
struct nvram_internal * data = (struct nvram_internal *)dev->private_data;
memcpy(dst, &(data->mem_state[data->thereg]), 1);
return 1;
}
-int nvram_write_data_port(ushort_t port,
- void * src,
- uint_t length,
- struct vm_device * dev) {
+static int nvram_write_data_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->mem_state[data->thereg]), src, 1);
-int nvram_init_device(struct vm_device * dev) {
-
- struct nvram_internal * data = (struct nvram_internal *)dev->private_data;
-
+static int nvram_init_device(struct vm_device * dev) {
PrintDebug("nvram: init_device\n");
- memset(data->mem_state, 0, NVRAM_REG_MAX);
-
- // Would read state here
- set_nvram_defaults(dev);
-
- nvram_reset_device(dev);
+ init_nvram_state(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);
+ v3_dev_hook_io(dev, NVRAM_REG_PORT, NULL, &nvram_write_reg_port);
+ v3_dev_hook_io(dev, NVRAM_DATA_PORT, &nvram_read_data_port, &nvram_write_data_port);
v3_hook_host_event(dev->vm, HOST_TIMER_EVT, V3_HOST_EVENT_HANDLER(handle_timer_event), dev);
return 0;
}
-int nvram_deinit_device(struct vm_device * dev) {
- dev_unhook_io(dev, NVRAM_REG_PORT);
- dev_unhook_io(dev, NVRAM_DATA_PORT);
+static int nvram_deinit_device(struct vm_device * dev) {
+ v3_dev_unhook_io(dev, NVRAM_REG_PORT);
+ v3_dev_unhook_io(dev, NVRAM_DATA_PORT);
nvram_reset_device(dev);
return 0;
-struct vm_device * create_nvram() {
+struct vm_device * v3_create_nvram() {
struct nvram_internal * nvram_state = NULL;
nvram_state = (struct nvram_internal *)V3_Malloc(sizeof(struct nvram_internal) + 1000);
- PrintDebug("nvram: internal at %x\n", nvram_state);
+ PrintDebug("nvram: internal at %p\n", (void *)nvram_state);
- struct vm_device * device = create_device("NVRAM", &dev_ops, nvram_state);
+ struct vm_device * device = v3_create_device("NVRAM", &dev_ops, nvram_state);
return device;
}
