270 lines
7.3 KiB
C
270 lines
7.3 KiB
C
/*
|
|
* Copyright (c) 2003 Michael Ruff (mruff at chiaro.com)
|
|
*
|
|
* This source code is free software; you can redistribute it
|
|
* and/or modify it in source code form under the terms of the GNU
|
|
* General Public License as published by the Free Software
|
|
* Foundation; either version 2 of the License, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA
|
|
*/
|
|
|
|
# include "vpi_config.h"
|
|
# include "vpi_user.h"
|
|
# include <stdio.h>
|
|
# include <string.h>
|
|
# include <math.h>
|
|
|
|
static double bits2double(PLI_UINT32 bits[2])
|
|
{
|
|
union conv {
|
|
double rval;
|
|
unsigned char bval[sizeof(double)];
|
|
} conv;
|
|
|
|
#ifdef WORDS_BIGENDIAN
|
|
conv.bval[7] = (bits[0] >> 0) & 0xff;
|
|
conv.bval[6] = (bits[0] >> 8) & 0xff;
|
|
conv.bval[5] = (bits[0] >> 16) & 0xff;
|
|
conv.bval[4] = (bits[0] >> 24) & 0xff;
|
|
conv.bval[3] = (bits[1] >> 0) & 0xff;
|
|
conv.bval[2] = (bits[1] >> 8) & 0xff;
|
|
conv.bval[1] = (bits[1] >> 16) & 0xff;
|
|
conv.bval[0] = (bits[1] >> 24) & 0xff;
|
|
#else
|
|
conv.bval[0] = (bits[0] >> 0) & 0xff;
|
|
conv.bval[1] = (bits[0] >> 8) & 0xff;
|
|
conv.bval[2] = (bits[0] >> 16) & 0xff;
|
|
conv.bval[3] = (bits[0] >> 24) & 0xff;
|
|
conv.bval[4] = (bits[1] >> 0) & 0xff;
|
|
conv.bval[5] = (bits[1] >> 8) & 0xff;
|
|
conv.bval[6] = (bits[1] >> 16) & 0xff;
|
|
conv.bval[7] = (bits[1] >> 24) & 0xff;
|
|
#endif
|
|
|
|
return conv.rval;
|
|
}
|
|
|
|
static void double2bits(double real, PLI_UINT32 bits[2])
|
|
{
|
|
union conv {
|
|
double rval;
|
|
unsigned char bval[sizeof(double)];
|
|
} conv;
|
|
|
|
conv.rval = real;
|
|
|
|
#ifdef WORDS_BIGENDIAN
|
|
bits[0] = conv.bval[7]
|
|
| (conv.bval[6] << 8)
|
|
| (conv.bval[5] <<16)
|
|
| (conv.bval[4] <<24);
|
|
bits[1] = conv.bval[3]
|
|
| (conv.bval[2] << 8)
|
|
| (conv.bval[1] <<16)
|
|
| (conv.bval[0] <<24);
|
|
#else
|
|
bits[0] = conv.bval[0]
|
|
| (conv.bval[1] << 8)
|
|
| (conv.bval[2] <<16)
|
|
| (conv.bval[3] <<24);
|
|
bits[1] = conv.bval[4]
|
|
| (conv.bval[5] << 8)
|
|
| (conv.bval[6] <<16)
|
|
| (conv.bval[7] <<24);
|
|
#endif
|
|
}
|
|
|
|
static void error_message(vpiHandle callh, const char* msg)
|
|
{
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf(msg, vpi_get_str(vpiName, callh));
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
|
|
static PLI_INT32 sizetf_32 (PLI_BYTE8*x) { return 32; }
|
|
static PLI_INT32 sizetf_64 (PLI_BYTE8*x) { return 64; }
|
|
|
|
static PLI_INT32 sys_convert_compiletf(PLI_BYTE8*name)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle argv = vpi_iterate(vpiArgument, callh);
|
|
vpiHandle arg;
|
|
|
|
/* Check that there is an argument. */
|
|
if (argv == 0) {
|
|
error_message(callh, "%s requires one argument.\n");
|
|
return 0;
|
|
}
|
|
|
|
/* In Icarus if we have an argv we have at least one argument. */
|
|
arg = vpi_scan(argv);
|
|
|
|
/* Validate the argument. Only $bitstoreal for now. */
|
|
if (!strcmp("$bitstoreal", name) && vpi_get(vpiSize, arg) != 64) {
|
|
error_message(callh, "%s requires a 64-bit argument.\n");
|
|
return 0;
|
|
}
|
|
|
|
/* Save the argument away to make the calltf faster. */
|
|
vpi_put_userdata(callh, (void *) arg);
|
|
|
|
/* These functions only take one argument. */
|
|
arg = vpi_scan(argv);
|
|
if (arg != 0) {
|
|
error_message(callh, "%s takes only one argument.\n");
|
|
return 0;
|
|
}
|
|
|
|
/* vpi_scan() returning 0 (NULL) had already freed argv. */
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 sys_bitstoreal_calltf(PLI_BYTE8*user)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle arg = (vpiHandle) vpi_get_userdata(callh);
|
|
s_vpi_value value;
|
|
|
|
PLI_UINT32 bits[2];
|
|
|
|
/* get value */
|
|
value.format = vpiVectorVal;
|
|
vpi_get_value(arg, &value);
|
|
|
|
/* convert */
|
|
bits[0] = (value.value.vector[0]).aval;
|
|
bits[1] = (value.value.vector[1]).aval;
|
|
value.value.real = bits2double(bits);
|
|
value.format = vpiRealVal;
|
|
|
|
/* return converted value */
|
|
vpi_put_value(callh, &value, 0, vpiNoDelay);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 sys_itor_calltf(PLI_BYTE8*user)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle arg = (vpiHandle) vpi_get_userdata(callh);
|
|
s_vpi_value value;
|
|
|
|
/* get value */
|
|
value.format = vpiIntVal;
|
|
vpi_get_value(arg, &value);
|
|
|
|
/* convert */
|
|
value.value.real = (PLI_INT32)value.value.integer;
|
|
value.format = vpiRealVal;
|
|
|
|
/* return converted value */
|
|
vpi_put_value(callh, &value, 0, vpiNoDelay);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 sys_realtobits_calltf(PLI_BYTE8*user)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle arg = (vpiHandle) vpi_get_userdata(callh);
|
|
s_vpi_value value;
|
|
static struct t_vpi_vecval res[2];
|
|
|
|
PLI_UINT32 bits[2];
|
|
|
|
/* get value */
|
|
value.format = vpiRealVal;
|
|
vpi_get_value(arg, &value);
|
|
|
|
/* convert */
|
|
double2bits(value.value.real, bits);
|
|
|
|
res[0].aval = bits[0];
|
|
res[0].bval = 0;
|
|
res[1].aval = bits[1];
|
|
res[1].bval = 0;
|
|
|
|
value.format = vpiVectorVal;
|
|
value.value.vector = res;
|
|
|
|
/* return converted value */
|
|
vpi_put_value(callh, &value, 0, vpiNoDelay);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 sys_rtoi_calltf(PLI_BYTE8*user)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle arg = (vpiHandle) vpi_get_userdata(callh);
|
|
s_vpi_value value;
|
|
static struct t_vpi_vecval res;
|
|
|
|
/* get value */
|
|
value.format = vpiRealVal;
|
|
vpi_get_value(arg, &value);
|
|
|
|
/* convert */
|
|
if (value.value.real >= 0.0)
|
|
res.aval = (unsigned)value.value.real;
|
|
else
|
|
res.aval = - (unsigned)-value.value.real;
|
|
res.bval = 0;
|
|
|
|
value.format = vpiVectorVal;
|
|
value.value.vector = &res;
|
|
|
|
/* return converted value */
|
|
vpi_put_value(callh, &value, 0, vpiNoDelay);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void sys_convert_register()
|
|
{
|
|
s_vpi_systf_data tf_data;
|
|
|
|
tf_data.type = vpiSysFunc;
|
|
tf_data.user_data = "$bitstoreal";
|
|
tf_data.tfname = tf_data.user_data;
|
|
tf_data.sizetf = sizetf_64;
|
|
tf_data.compiletf = sys_convert_compiletf;
|
|
tf_data.calltf = sys_bitstoreal_calltf;
|
|
vpi_register_systf(&tf_data);
|
|
|
|
tf_data.type = vpiSysFunc;
|
|
tf_data.user_data = "$itor";
|
|
tf_data.tfname = tf_data.user_data;
|
|
tf_data.sizetf = sizetf_64;
|
|
tf_data.compiletf = sys_convert_compiletf;
|
|
tf_data.calltf = sys_itor_calltf;
|
|
vpi_register_systf(&tf_data);
|
|
|
|
tf_data.type = vpiSysFunc;
|
|
tf_data.user_data = "$realtobits";
|
|
tf_data.tfname = tf_data.user_data;
|
|
tf_data.sizetf = sizetf_64;
|
|
tf_data.compiletf = sys_convert_compiletf;
|
|
tf_data.calltf = sys_realtobits_calltf;
|
|
vpi_register_systf(&tf_data);
|
|
|
|
tf_data.type = vpiSysFunc;
|
|
tf_data.user_data = "$rtoi";
|
|
tf_data.tfname = tf_data.user_data;
|
|
tf_data.sizetf = sizetf_32;
|
|
tf_data.compiletf = sys_convert_compiletf;
|
|
tf_data.calltf = sys_rtoi_calltf;
|
|
vpi_register_systf(&tf_data);
|
|
}
|
|
|