palacios/src/devices/filedisk.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 <palacios/vmm_dev_mgr.h>
  22
  23 #include <interfaces/vmm_file.h>
  24 #include <palacios/vm_guest.h>
  25
  26 #ifndef V3_CONFIG_DEBUG_FILEDISK
  27 #undef PrintDebug
  28 #define PrintDebug(fmt, args...)
  29 #endif
  30
  31 struct disk_state {
  32     uint64_t capacity; // in bytes
  33
  34     v3_file_t fd;
  35 };
  36
  37
  38
  39 static int write_all(v3_file_t fd, char * buf, uint64_t offset, uint64_t length) {
  40     uint64_t bytes_written = 0;
  41
  42     PrintDebug("Writing %llu bytes\n", length - bytes_written);
  43     while (bytes_written < length) {
  44         int tmp_bytes = v3_file_write(fd, buf + bytes_written, length - bytes_written, offset + bytes_written);
  45         PrintDebug("Wrote %d bytes\n", tmp_bytes);
  46
  47         if (tmp_bytes <= 0 ) {
  48             PrintError("Write failed\n");
  49             return -1;
  50         }
  51
  52         bytes_written += tmp_bytes;
  53     }
  54
  55     return 0;
  56 }
  57
  58
  59 static int read_all(v3_file_t fd, char * buf, uint64_t offset, uint64_t length) {
  60     uint64_t bytes_read = 0;
  61
  62     PrintDebug("Reading %llu bytes\n", length - bytes_read);
  63     while (bytes_read < length) {
  64         int tmp_bytes = v3_file_read(fd, buf + bytes_read, length - bytes_read, offset + bytes_read);
  65         PrintDebug("Read %d bytes\n", tmp_bytes);
  66
  67         if (tmp_bytes <= 0) {
  68             PrintError("Read failed\n");
  69             return -1;
  70         }
  71
  72         bytes_read += tmp_bytes;
  73     }
  74
  75     return 0;
  76 }
  77
  78 static int read(uint8_t * buf, uint64_t lba, uint64_t num_bytes, void * private_data) {
  79     struct disk_state * disk = (struct disk_state *)private_data;
  80
  81     PrintDebug("Reading %llu bytes from %p to %p\n", num_bytes, (uint8_t *)(disk->disk_image + lba), buf);
  82
  83     if (lba + num_bytes > disk->capacity) {
  84         PrintError("Out of bounds read: lba=%llu, num_bytes=%llu, capacity=%llu\n",
  85                    lba, num_bytes, disk->capacity);
  86         return -1;
  87     }
  88
  89     return read_all(disk->fd, buf, lba, num_bytes);
  90 }
  91
  92
  93 static int write(uint8_t * buf, uint64_t lba, uint64_t num_bytes, void * private_data) {
  94     struct disk_state * disk = (struct disk_state *)private_data;
  95
  96     PrintDebug("Writing %llu bytes from %p to %p\n", num_bytes,  buf, (uint8_t *)(disk->disk_image + lba));
  97
  98     if (lba + num_bytes > disk->capacity) {
  99         PrintError("Out of bounds read: lba=%llu, num_bytes=%llu, capacity=%llu\n",
 100                    lba, num_bytes, disk->capacity);
 101         return -1;
 102     }
 103
 104
 105     return write_all(disk->fd,  buf, lba, num_bytes);
 106 }
 107
 108
 109 static uint64_t get_capacity(void * private_data) {
 110     struct disk_state * disk = (struct disk_state *)private_data;
 111
 112     PrintDebug("Querying FILEDISK capacity %llu\n", disk->capacity);
 113
 114     return disk->capacity;
 115 }
 116
 117 static struct v3_dev_blk_ops blk_ops = {
 118     .read = read,
 119     .write = write,
 120     .get_capacity = get_capacity,
 121 };
 122
 123
 124
 125
 126 static int disk_free(struct disk_state * disk) {
 127     v3_file_close(disk->fd);
 128
 129     V3_Free(disk);
 130     return 0;
 131 }
 132
 133 static struct v3_device_ops dev_ops = {
 134     .free = (int (*)(void *))disk_free,
 135 };
 136
 137
 138
 139
 140 static int disk_init(struct v3_vm_info * vm, v3_cfg_tree_t * cfg) {
 141     struct disk_state * disk = NULL;
 142     char * path = v3_cfg_val(cfg, "path");
 143     char * dev_id = v3_cfg_val(cfg, "ID");
 144     char * writable = v3_cfg_val(cfg, "writable");
 145     v3_cfg_tree_t * frontend_cfg = v3_cfg_subtree(cfg, "frontend");
 146     int flags = FILE_OPEN_MODE_READ;
 147
 148     if ( (writable) && (writable[0] == '1') ) {
 149         flags |= FILE_OPEN_MODE_WRITE;
 150     }
 151
 152     if (path == NULL) {
 153         PrintError("Missing path (%s) for %s\n", path, dev_id);
 154         return -1;
 155     }
 156
 157     disk = (struct disk_state *)V3_Malloc(sizeof(struct disk_state));
 158
 159     if (disk == NULL) {
 160         PrintError("Could not allocate disk\n");
 161         return -1;
 162     }
 163
 164     memset(disk, 0, sizeof(struct disk_state));
 165
 166     struct vm_device * dev = v3_add_device(vm, dev_id, &dev_ops, disk);
 167
 168     if (dev == NULL) {
 169         PrintError("Could not attach device %s\n", dev_id);
 170         V3_Free(disk);
 171         return -1;
 172     }
 173
 174
 175     disk->fd = v3_file_open(vm, path, flags);
 176
 177     if (disk->fd == NULL) {
 178         PrintError("Could not open file disk:%s\n", path);
 179         v3_remove_device(dev);
 180         return -1;
 181     }
 182
 183     disk->capacity = v3_file_size(disk->fd);
 184
 185     V3_Print("Registering FILEDISK %s (path=%s, fd=%lu, size=%llu)\n",
 186              dev_id, path, (addr_t)disk->fd, disk->capacity);
 187
 188
 189     if (v3_dev_connect_blk(vm, v3_cfg_val(frontend_cfg, "tag"),
 190                            &blk_ops, frontend_cfg, disk) == -1) {
 191         PrintError("Could not connect %s to frontend %s\n",
 192                    dev_id, v3_cfg_val(frontend_cfg, "tag"));
 193         v3_remove_device(dev);
 194         return -1;
 195     }
 196
 197
 198     return 0;
 199 }
 200
 201
 202 device_register("FILEDISK", disk_init)