palacios/src/devices/ram_hd.c

   1 /*
   2  * This file is part of the Palacios Virtual Machine Monitor developed
   3  * by the V3VEE Project with funding from the United States National
   4  * Science Foundation and the Department of Energy.
   5  *
   6  * The V3VEE Project is a joint project between Northwestern University
   7  * and the University of New Mexico.  You can find out more at
   8  * http://www.v3vee.org
   9  *
  10  * Copyright (c) 2008, Jack Lange <jarusl@cs.northwestern.edu>
  11  * Copyright (c) 2008, The V3VEE Project <http://www.v3vee.org>
  12  * All rights reserved.
  13  *
  14  * Author: Jack Lange <jarusl@cs.northwestern.edu>
  15  *
  16  * This is free software.  You are permitted to use,
  17  * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
  18  */
  19
  20 #include <palacios/vmm.h>
  21 #include <devices/ram_hd.h>
  22 #include <devices/ide.h>
  23
  24
  25
  26 #ifndef DEBUG_IDE
  27 #undef PrintDebug
  28 #define PrintDebug(fmt, args...)
  29 #endif
  30
  31 struct hd_state {
  32     addr_t disk_image;
  33     uint32_t capacity; // in bytes
  34
  35     struct vm_device * ide;
  36
  37     uint_t bus;
  38     uint_t drive;
  39 };
  40
  41
  42 // HDs always read 512 byte blocks... ?
  43 static int hd_read(uint8_t * buf, int sector_count, uint64_t lba,  void * private_data) {
  44     struct vm_device * hd_dev = (struct vm_device *)private_data;
  45     struct hd_state * hd = (struct hd_state *)(hd_dev->private_data);
  46     int offset = lba * IDE_SECTOR_SIZE;
  47     int length = sector_count * IDE_SECTOR_SIZE;
  48
  49     //    PrintDebug("Reading RAM HD at (LBA=%d) offset %d (length=%d)\n", (uint32_t)lba, offset, length);
  50
  51     memcpy(buf, (uint8_t *)(hd->disk_image + offset), length);
  52
  53     return 0;
  54 }
  55
  56
  57 static int hd_write(uint8_t * buf, int sector_count, uint64_t lba, void * private_data) {
  58     struct vm_device * hd_dev = (struct vm_device *)private_data;
  59     struct hd_state * hd = (struct hd_state *)(hd_dev->private_data);
  60     int offset = lba * IDE_SECTOR_SIZE;
  61     int length = sector_count * IDE_SECTOR_SIZE;
  62
  63     memcpy((uint8_t *)(hd->disk_image + offset), buf, length);
  64
  65     return 0;
  66 }
  67
  68
  69 static uint64_t hd_get_capacity(void * private_data) {
  70     struct vm_device * hd_dev = (struct vm_device *)private_data;
  71     struct hd_state * hd = (struct hd_state *)(hd_dev->private_data);
  72     PrintDebug("Querying RAM HD capacity (bytes=%d) (ret = %d)\n",
  73                hd->capacity, hd->capacity  / IDE_SECTOR_SIZE);
  74     return hd->capacity / IDE_SECTOR_SIZE;
  75 }
  76
  77 static struct v3_ide_hd_ops hd_ops = {
  78     .read = hd_read,
  79     .write = hd_write,
  80     .get_capacity = hd_get_capacity,
  81 };
  82
  83
  84 static int hd_init(struct vm_device * dev) {
  85     struct hd_state * hd = (struct hd_state *)(dev->private_data);
  86
  87     if (v3_ide_register_harddisk(hd->ide, hd->bus, hd->drive, "V3-RAM-HD", &hd_ops, dev) == -1) {
  88         return -1;
  89     }
  90
  91     return 0;
  92 }
  93
  94
  95 static int hd_deinit(struct vm_device * dev) {
  96     return 0;
  97 }
  98
  99 static struct vm_device_ops dev_ops = {
 100     .init = hd_init,
 101     .deinit = hd_deinit,
 102     .reset = NULL,
 103     .start = NULL,
 104     .stop = NULL,
 105 };
 106
 107 struct vm_device * v3_create_ram_hd(struct vm_device * ide,
 108                                     uint_t bus, uint_t drive,
 109                                     addr_t ramdisk, uint32_t size) {
 110     struct hd_state * hd = NULL;
 111
 112     if (size % IDE_SECTOR_SIZE) {
 113         PrintError("HD image must be an integral of sector size (IDE_SECTOR_SIZE=%d)\n", IDE_SECTOR_SIZE);
 114         return NULL;
 115     }
 116
 117     hd = (struct hd_state *)V3_Malloc(sizeof(struct hd_state));
 118
 119     PrintDebug("Registering Ram HDD at %p (size=%d)\n", (void *)ramdisk, size);
 120
 121     hd->disk_image = ramdisk;
 122     hd->capacity = size;
 123
 124     hd->ide = ide;
 125     hd->bus = bus;
 126     hd->drive = drive;
 127
 128     struct vm_device * hd_dev = v3_create_device("RAM-HD", &dev_ops, hd);
 129
 130     return hd_dev;
 131 }