litex/vpi/main.c

204 lines
4.0 KiB
C

/*
* Copyright (C) 2012 Vermeer Manufacturing Co.
* License: GPLv3 with additional permissions (see README).
*/
#include <assert.h>
#include <stdio.h>
#include <stdlib.h>
#include <vpi_user.h>
#include "ipc.h"
struct migensim_softc {
struct ipc_softc *ipc;
int has_go;
};
static int h_go(void *user)
{
struct migensim_softc *sc = (struct migensim_softc *)user;
sc->has_go = 1;
return 1;
}
static s_vpi_time zero_delay = {
.type = vpiSimTime,
.high = 0,
.low = 0
};
static int h_write(char *name, int index, int nchunks, const unsigned char *chunks, void *user)
{
vpiHandle item;
s_vpi_vecval vector[64];
int i;
s_vpi_value value;
item = vpi_handle_by_name(name, NULL);
if(item == NULL) {
fprintf(stderr, "Attempted to write non-existing signal %s\n", name);
return 0;
}
if(vpi_get(vpiType, item) == vpiMemory)
item = vpi_handle_by_index(item, index);
else
assert(index == 0);
assert(nchunks <= 255);
for(i=0;i<64;i++) {
vector[i].aval = 0;
vector[i].bval = 0;
}
for(i=0;i<nchunks;i++)
vector[i/4].aval |= chunks[i] << 8*(i % 4);
value.format = vpiVectorVal;
value.value.vector = vector;
vpi_put_value(item, &value, &zero_delay, vpiInertialDelay);
return 1;
}
static int h_read(char *name, int index, void *user)
{
struct migensim_softc *sc = (struct migensim_softc *)user;
vpiHandle item;
s_vpi_value value;
int size;
int i;
int nvals;
unsigned int vals[64];
int nchunks;
unsigned char chunks[255];
item = vpi_handle_by_name(name, NULL);
if(item == NULL) {
fprintf(stderr, "Attempted to read non-existing signal %s\n", name);
return 0;
}
if(vpi_get(vpiType, item) == vpiMemory)
item = vpi_handle_by_index(item, index);
else
assert(index == 0);
value.format = vpiVectorVal;
vpi_get_value(item, &value);
size = vpi_get(vpiSize, item);
nvals = (size + 31)/32;
assert(nvals <= 64);
for(i=0;i<nvals;i++)
vals[i] = value.value.vector[i].aval & ~value.value.vector[i].bval;
nchunks = (size + 7)/8;
assert(nchunks <= 255);
for(i=0;i<nchunks;i++) {
switch(i % 4) {
case 0:
chunks[i] = vals[i/4] & 0xff;
break;
case 1:
chunks[i] = (vals[i/4] & 0xff00) >> 8;
break;
case 2:
chunks[i] = (vals[i/4] & 0xff0000) >> 16;
break;
case 3:
chunks[i] = (vals[i/4] & 0xff000000) >> 24;
break;
}
}
if(!ipc_read_reply(sc->ipc, nchunks, chunks)) {
perror("ipc_read_reply");
return 0;
}
return 1;
}
static int process_until_go(struct migensim_softc *sc)
{
int r;
sc->has_go = 0;
while(!sc->has_go) {
r = ipc_receive(sc->ipc);
if(r != 1)
return r;
}
return 1;
}
static PLI_INT32 connect_calltf(PLI_BYTE8 *user)
{
struct migensim_softc *sc = (struct migensim_softc *)user;
vpiHandle sys;
vpiHandle argv;
vpiHandle item;
s_vpi_value value;
sys = vpi_handle(vpiSysTfCall, 0);
argv = vpi_iterate(vpiArgument, sys);
item = vpi_scan(argv);
value.format = vpiStringVal;
vpi_get_value(item, &value);
sc->ipc = ipc_connect(value.value.str, h_go, h_write, h_read, sc);
if(sc->ipc == NULL) {
perror("ipc_connect");
vpi_control(vpiFinish, 1);
return 0;
}
return 0;
}
static PLI_INT32 tick_calltf(PLI_BYTE8 *user)
{
struct migensim_softc *sc = (struct migensim_softc *)user;
int r;
if(!ipc_tick(sc->ipc)) {
perror("ipc_tick");
vpi_control(vpiFinish, 1);
ipc_destroy(sc->ipc);
sc->ipc = NULL;
return 0;
}
r = process_until_go(sc);
if(r != 1) {
vpi_control(vpiFinish, r == 2 ? 0 : 1);
ipc_destroy(sc->ipc);
sc->ipc = NULL;
return 0;
}
return 0;
}
static struct migensim_softc sc;
static void simple_register(const char *tfname, PLI_INT32 (*calltf)(PLI_BYTE8 *))
{
s_vpi_systf_data tf_data;
tf_data.type = vpiSysTask;
tf_data.tfname = tfname;
tf_data.calltf = calltf;
tf_data.compiletf = NULL;
tf_data.sizetf = 0;
tf_data.user_data = (void *)&sc;
vpi_register_systf(&tf_data);
}
static void migensim_register()
{
simple_register("$migensim_connect", connect_calltf);
simple_register("$migensim_tick", tick_calltf);
}
void (*vlog_startup_routines[])() = {
migensim_register,
0
};