1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114
|
/*
* Cisco router simulation platform.
* Copyright (c) 2007 Christophe Fillot (cf@utc.fr)
*
* Byte-swapping device.
*/
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <assert.h>
#include "cpu.h"
#include "vm.h"
#include "dynamips.h"
#include "memory.h"
#include "device.h"
struct bswap_data {
/* VM object info */
vm_obj_t vm_obj;
/* VM instance */
vm_instance_t *vm;
/* Byte-swap device */
struct vdevice dev;
/* Physical address base for rewrite */
m_uint64_t phys_base;
};
/*
* Byte swapped access.
*/
static void *dev_bswap_access(cpu_gen_t *cpu,struct vdevice *dev,
m_uint32_t offset,u_int op_size,u_int op_type,
m_uint64_t *data)
{
struct bswap_data *d = dev->priv_data;
m_uint64_t paddr;
paddr = d->phys_base + offset;
switch(op_size) {
case 1:
if (op_type == MTS_READ)
*data = physmem_copy_u8_from_vm(d->vm,paddr ^ 0x03);
else
physmem_copy_u8_to_vm(d->vm,paddr ^ 0x03,*data);
break;
case 2:
if (op_type == MTS_READ)
*data = swap16(physmem_copy_u16_from_vm(d->vm,paddr ^ 0x02));
else
physmem_copy_u16_to_vm(d->vm,paddr ^ 0x02,swap16(*data));
break;
case 4:
if (op_type == MTS_READ)
*data = swap32(physmem_copy_u32_from_vm(d->vm,paddr));
else
physmem_copy_u32_to_vm(d->vm,paddr,swap32(*data));
break;
}
return NULL;
}
/* Shutdown an byte-swap device */
void dev_bswap_shutdown(vm_instance_t *vm,struct bswap_data *d)
{
if (d != NULL) {
/* Remove the alias, the byte-swapped and the main device */
dev_remove(vm,&d->dev);
/* Free the structure itself */
free(d);
}
}
/* Initialized a byte-swap device */
int dev_bswap_init(vm_instance_t *vm,char *name,
m_uint64_t paddr,m_uint32_t len,
m_uint64_t remap_addr)
{
struct bswap_data *d;
if (!(d = malloc(sizeof(*d)))) {
fprintf(stderr,"BSWAP: unable to create device.\n");
return(-1);
}
vm_object_init(&d->vm_obj);
d->vm = vm;
d->phys_base = remap_addr;
d->vm_obj.name = name;
d->vm_obj.data = d;
d->vm_obj.shutdown = (vm_shutdown_t)dev_bswap_shutdown;
dev_init(&d->dev);
d->dev.name = name;
d->dev.phys_addr = paddr;
d->dev.phys_len = len;
d->dev.handler = dev_bswap_access;
d->dev.priv_data = d;
/* Map this device to the VM */
vm_bind_device(vm,&d->dev);
vm_object_add(vm,&d->vm_obj);
return(0);
}
|