/* 
 * 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, Jack Lange <jarusl@cs.northwestern.edu> 
 * Copyright (c) 2008, The V3VEE Project <http://www.v3vee.org> 
 * All rights reserved.
 *
 * Author: Jack Lange <jarusl@cs.northwestern.edu>
 *
 * This is free software.  You are permitted to use,
 * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
 */

#include <palacios/vmm.h>
#include <palacios/vmm_dev_mgr.h>

#include <interfaces/vmm_file.h>
#include <palacios/vm_guest.h>

#ifndef V3_CONFIG_DEBUG_FILEDISK
#undef PrintDebug
#define PrintDebug(fmt, args...)
#endif

struct disk_state {
    uint64_t capacity; // in bytes

    v3_file_t fd;
};



static int write_all(v3_file_t fd, char * buf, uint64_t offset, uint64_t length) {
    uint64_t bytes_written = 0;
    
    PrintDebug(VM_NONE, VCORE_NONE, "Writing %llu bytes\n", length - bytes_written);
    while (bytes_written < length) {
	int tmp_bytes = v3_file_write(fd, buf + bytes_written, length - bytes_written, offset + bytes_written);
	PrintDebug(VM_NONE, VCORE_NONE, "Wrote %d bytes\n", tmp_bytes);
	
	if (tmp_bytes <= 0 ) {
	    PrintError(VM_NONE, VCORE_NONE, "Write failed\n");
	    return -1;
	}
	
	bytes_written += tmp_bytes;
    }
    
    return 0;
}


static int read_all(v3_file_t fd, char * buf, uint64_t offset, uint64_t length) {
    uint64_t bytes_read = 0;
    
    PrintDebug(VM_NONE, VCORE_NONE, "Reading %llu bytes\n", length - bytes_read);
    while (bytes_read < length) {
	int tmp_bytes = v3_file_read(fd, buf + bytes_read, length - bytes_read, offset + bytes_read);
	PrintDebug(VM_NONE, VCORE_NONE, "Read %d bytes\n", tmp_bytes);
	
	if (tmp_bytes <= 0) {
	    PrintError(VM_NONE, VCORE_NONE, "Read failed\n");
	    return -1;
	}
	
	bytes_read += tmp_bytes;
    }
    
    return 0;
}

static int read(uint8_t * buf, uint64_t lba, uint64_t num_bytes, void * private_data) {
    struct disk_state * disk = (struct disk_state *)private_data;

    PrintDebug(VM_NONE, VCORE_NONE, "Reading %llu bytes from %llu to 0x%p\n", num_bytes, lba, buf);

    if (lba + num_bytes > disk->capacity) {
	PrintError(VM_NONE, VCORE_NONE, "Out of bounds read: lba=%llu, num_bytes=%llu, capacity=%llu\n",
		   lba, num_bytes, disk->capacity);
	return -1;
    }

    return read_all(disk->fd, buf, lba, num_bytes);
}


static int write(uint8_t * buf, uint64_t lba, uint64_t num_bytes, void * private_data) {
    struct disk_state * disk = (struct disk_state *)private_data;

    PrintDebug(VM_NONE, VCORE_NONE, "Writing %llu bytes from 0x%p to %llu\n", num_bytes,  buf, lba);

    if (lba + num_bytes > disk->capacity) {
	PrintError(VM_NONE, VCORE_NONE, "Out of bounds read: lba=%llu, num_bytes=%llu, capacity=%llu\n",
		   lba, num_bytes, disk->capacity);
	return -1;
    }


    return write_all(disk->fd,  buf, lba, num_bytes);
}


static uint64_t get_capacity(void * private_data) {
    struct disk_state * disk = (struct disk_state *)private_data;

    PrintDebug(VM_NONE, VCORE_NONE, "Querying FILEDISK capacity %llu\n", disk->capacity);

    return disk->capacity;
}

static struct v3_dev_blk_ops blk_ops = {
    .read = read, 
    .write = write,
    .get_capacity = get_capacity,
};




static int disk_free(struct disk_state * disk) {
    v3_file_close(disk->fd);
    
    V3_Free(disk);
    return 0;
}

static struct v3_device_ops dev_ops = {
    .free = (int (*)(void *))disk_free,
};




static int disk_init(struct v3_vm_info * vm, v3_cfg_tree_t * cfg) {
    struct disk_state * disk = NULL;
    char * path = v3_cfg_val(cfg, "path");
    char * dev_id = v3_cfg_val(cfg, "ID");
    char * writable = v3_cfg_val(cfg, "writable");
    char * writeable = v3_cfg_val(cfg, "writeable");

    v3_cfg_tree_t * frontend_cfg = v3_cfg_subtree(cfg, "frontend");
    int flags = FILE_OPEN_MODE_READ;

    if ( ((writable) && (writable[0] == '1')) ||
	 ((writeable) && (writeable[0] == '1')) ) {
	flags |= FILE_OPEN_MODE_WRITE;
    }

    if (path == NULL) {
	PrintError(vm, VCORE_NONE, "Missing path (%s) for %s\n", path, dev_id);
	return -1;
    }

    disk = (struct disk_state *)V3_Malloc(sizeof(struct disk_state));

    if (disk == NULL) {
	PrintError(vm, VCORE_NONE, "Could not allocate disk\n");
	return -1;
    }

    memset(disk, 0, sizeof(struct disk_state));

    struct vm_device * dev = v3_add_device(vm, dev_id, &dev_ops, disk);

    if (dev == NULL) {
	PrintError(vm, VCORE_NONE, "Could not attach device %s\n", dev_id);
	V3_Free(disk);
	return -1;
    }


    disk->fd = v3_file_open(vm, path, flags);

    if (disk->fd == NULL) {
	PrintError(vm, VCORE_NONE, "Could not open file disk:%s\n", path);
	v3_remove_device(dev);
	return -1;
    }

    disk->capacity = v3_file_size(disk->fd);

    V3_Print(vm, VCORE_NONE, "Registering FILEDISK %s (path=%s, fd=%lu, size=%llu, writeable=%d)\n",
	     dev_id, path, (addr_t)disk->fd, disk->capacity,
	     flags & FILE_OPEN_MODE_WRITE);


    if (v3_dev_connect_blk(vm, v3_cfg_val(frontend_cfg, "tag"), 
			   &blk_ops, frontend_cfg, disk) == -1) {
	PrintError(vm, VCORE_NONE, "Could not connect %s to frontend %s\n", 
		   dev_id, v3_cfg_val(frontend_cfg, "tag"));
	v3_remove_device(dev);
	return -1;
    }
    

    return 0;
}


device_register("FILEDISK", disk_init)