-/* (c) 2008, Peter Dinda <pdinda@northwestern.edu> */
-/* (c) 2008, The V3VEE Project <http://www.v3vee.org> */
+/*
+ * This file is part of the Palacios Virtual Machine Monitor developed
+ * by the V3VEE Project with funding from the United States National
+ * Science Foundation and the Department of Energy.
+ *
+ * The V3VEE Project is a joint project between Northwestern University
+ * and the University of New Mexico. You can find out more at
+ * http://www.v3vee.org
+ *
+ * Copyright (c) 2008, Peter Dinda <pdinda@northwestern.edu>
+ * Copyright (c) 2008, The V3VEE Project <http://www.v3vee.org>
+ * All rights reserved.
+ *
+ * Author: Peter Dinda <pdinda@northwestern.edu>
+ *
+ * This is free software. You are permitted to use,
+ * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
+ */
+
#include <devices/nvram.h>
#include <palacios/vmm.h>
#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
-struct vm_device * thedev = NULL;
-
-static struct vm_device * demultiplex_timer_interrupt(uint_t period_us)
-{
- // hack
- return thedev;
-}
-
struct bcd_num {
uchar_t bot : 4;
uchar_t top : 4;
-} ;
+};
+
-static uchar_t add_to(uchar_t * left, uchar_t * right, uchar_t bcd)
-{
+
+static uchar_t add_to(uchar_t * left, uchar_t * right, uchar_t bcd) {
uchar_t temp;
if (bcd) {
return 0;
}
}
-
}
-static uchar_t days_in_month(struct vm_device *dev, uchar_t month, uchar_t bcd)
-{
+static uchar_t days_in_month(struct vm_device * dev, uchar_t month, uchar_t bcd) {
// This completely ignores Julian / Gregorian stuff right now
if (bcd) {
}
-static void update_time(struct vm_device *dev, uint_t period_us)
-{
+static void update_time(struct vm_device * dev, uint_t period_us) {
struct nvram_internal * data = (struct nvram_internal *) (dev->private_data);
struct rtc_stata * stata = (struct rtc_stata *) &((data->mem_state[NVRAM_REG_STAT_A]));
struct rtc_statb * statb = (struct rtc_statb *) &((data->mem_state[NVRAM_REG_STAT_B]));
// 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);
}
}
+static int handle_timer_event(struct guest_info * info,
+ struct v3_timer_event * evt,
+ void * priv_data) {
-
-void deliver_timer_interrupt_to_vmm(uint_t period_us)
-{
- struct vm_device * dev = demultiplex_timer_interrupt(period_us);
+ struct vm_device * dev = (struct vm_device *)priv_data;
if (dev) {
- update_time(dev, period_us);
+ update_time(dev, evt->period_us);
}
+ 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);
//
// 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;
- return 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)
-{
- struct nvram_internal * data = (struct nvram_internal *) dev->private_data;
-
-
+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 nvram_internal * nvram_state = (struct nvram_internal *)V3_Malloc(sizeof(struct nvram_internal) + 1000);
-
- PrintDebug("nvram: internal at %x\n",nvram_state);
+struct vm_device * v3_create_nvram() {
+ struct nvram_internal * nvram_state = NULL;
- struct vm_device * device = create_device("NVRAM", &dev_ops, nvram_state);
+ nvram_state = (struct nvram_internal *)V3_Malloc(sizeof(struct nvram_internal) + 1000);
- if (thedev != NULL) {
- PrintDebug("nvram: warning! overwriting thedev\n");
- }
+ PrintDebug("nvram: internal at %p\n", (void *)nvram_state);
- thedev = device;
+ struct vm_device * device = v3_create_device("NVRAM", &dev_ops, nvram_state);
return device;
}
