385 lines
13 KiB
C
385 lines
13 KiB
C
/*
|
|
* Copyright (c) 2012-2015 Stephen Williams (steve@icarus.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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
|
*/
|
|
|
|
|
|
# include "sys_priv.h"
|
|
# include <assert.h>
|
|
# include <math.h>
|
|
# include <stdlib.h>
|
|
# include <string.h>
|
|
static PLI_INT32 dobject_size_compiletf(ICARUS_VPI_CONST PLI_BYTE8*name)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle argv, arg;
|
|
|
|
argv = vpi_iterate(vpiArgument, callh);
|
|
if (argv == 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s requires a dynamic array, queue or string "
|
|
"argument.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
return 0;
|
|
}
|
|
|
|
arg = vpi_scan(argv); /* This should never be zero. */
|
|
assert(arg);
|
|
|
|
/* The argument must be a dynamic array, queue or string. */
|
|
switch (vpi_get(vpiType, arg)) {
|
|
case vpiStringVar:
|
|
break;
|
|
case vpiArrayVar:
|
|
switch(vpi_get(vpiArrayType, arg)) {
|
|
case vpiDynamicArray:
|
|
case vpiQueueArray:
|
|
break;
|
|
default:
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s argument must be a dynamic array, queue or "
|
|
"string.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
break;
|
|
default:
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s argument must be a dynamic array, queue or string, "
|
|
"given a %s.\n", name, vpi_get_str(vpiType, arg));
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
|
|
arg = vpi_scan(argv);
|
|
if (arg != 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s has too many arguments.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
vpi_free_object(argv);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 dobject_size_calltf(ICARUS_VPI_CONST PLI_BYTE8*name)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle argv = vpi_iterate(vpiArgument, callh);
|
|
vpiHandle arg = vpi_scan(argv);
|
|
|
|
(void)name; /* Parameter is not used. */
|
|
|
|
vpi_free_object(argv);
|
|
|
|
s_vpi_value value;
|
|
value.format = vpiIntVal;
|
|
value.value.integer = vpi_get(vpiSize, arg);
|
|
|
|
vpi_put_value(callh, &value, 0, vpiNoDelay);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 to_from_vec_compiletf(ICARUS_VPI_CONST PLI_BYTE8*name)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle argv, arg;
|
|
|
|
argv = vpi_iterate(vpiArgument, callh);
|
|
if (argv == 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s requires two arguments.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
return 0;
|
|
}
|
|
|
|
/* The first argument must be a dynamic array. */
|
|
arg = vpi_scan(argv); /* This should never be zero. */
|
|
assert(arg);
|
|
if (vpi_get(vpiType, arg) != vpiArrayVar) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s first argument must be a dynamic array, "
|
|
"given a %s.\n", name, vpi_get_str(vpiType, arg));
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
if (vpi_get(vpiArrayType, arg) != vpiDynamicArray) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s first argument must be a dynamic array.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
|
|
/* The second argument must be a net, reg or bit variable. */
|
|
arg = vpi_scan(argv);
|
|
if (arg == 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s requires a second argument.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
switch(vpi_get(vpiType, arg)) {
|
|
case vpiNet:
|
|
case vpiReg:
|
|
case vpiBitVar:
|
|
case vpiIntegerVar:
|
|
break;
|
|
default:
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s second argument must be a logical net or "
|
|
"variable.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
}
|
|
|
|
arg = vpi_scan(argv);
|
|
if (arg != 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s has too many arguments.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
vpi_free_object(argv);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const size_t BPW = 8 * sizeof(PLI_INT32);
|
|
static const size_t BPWM1 = 8 * sizeof(PLI_INT32) - 1;
|
|
|
|
static PLI_INT32 to_vec_calltf(ICARUS_VPI_CONST PLI_BYTE8*name)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle argv = vpi_iterate(vpiArgument, callh);
|
|
vpiHandle darr = vpi_scan(argv);
|
|
vpiHandle vec = vpi_scan(argv);
|
|
s_vpi_value darr_val;
|
|
s_vpi_vecval*vec_val;
|
|
|
|
vpi_free_object(argv);
|
|
|
|
int darr_size = vpi_get(vpiSize, darr);
|
|
int darr_word_size = vpi_get(vpiSize, vpi_handle_by_index(darr, 0));
|
|
int darr_bit_size = darr_size * darr_word_size;
|
|
|
|
int vec_size = vpi_get(vpiSize, vec);
|
|
|
|
if (darr_size <= 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s cannot cast an empty dynamic array.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
return 0;
|
|
}
|
|
|
|
if (darr_bit_size != vec_size) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s dynamic array and vector size do not match "
|
|
"(%d != %d).\n", name, darr_bit_size, vec_size);
|
|
vpi_control(vpiFinish, 1);
|
|
return 0;
|
|
}
|
|
|
|
/* Conversion part */
|
|
int vec_number = (darr_bit_size + BPWM1) / BPW;
|
|
vec_val = calloc(vec_number, sizeof(s_vpi_vecval));
|
|
|
|
int darr_number = (darr_word_size + BPWM1) / BPW;
|
|
|
|
darr_val.format = vpiVectorVal;
|
|
unsigned int offset = 0;
|
|
s_vpi_vecval*vec_val_ptr = vec_val;
|
|
vec_val_ptr->aval = 0;
|
|
vec_val_ptr->bval = 0;
|
|
|
|
/* We have to reverse the order of the dynamic array, no memcpy here */
|
|
for(int i = darr_size - 1; i >= 0; --i) {
|
|
unsigned int bits_to_copy = darr_word_size;
|
|
vpiHandle darr_word = vpi_handle_by_index(darr, i);
|
|
vpi_get_value(darr_word, &darr_val);
|
|
assert(darr_val.value.vector);
|
|
|
|
for(int j = 0; j < darr_number; ++j) {
|
|
PLI_INT32 aval = darr_val.value.vector->aval;
|
|
PLI_INT32 bval = darr_val.value.vector->bval;
|
|
|
|
if(offset < BPW) {
|
|
vec_val_ptr->aval |= (aval << offset);
|
|
vec_val_ptr->bval |= (bval << offset);
|
|
}
|
|
|
|
offset += bits_to_copy > BPW ? BPW : bits_to_copy;
|
|
|
|
if(offset >= BPW) {
|
|
++vec_val_ptr;
|
|
vec_val_ptr->aval = 0;
|
|
vec_val_ptr->bval = 0;
|
|
|
|
// is the current word crossing the s_vpi_vecval boundary?
|
|
if(offset > BPW) {
|
|
// this assert is to warn you, that the following
|
|
// part could not be tested at the moment of writing
|
|
// (dynamic arrays work with vectors of 8, 16, 32, 64
|
|
// bits, so there is no chance that one of the vectors
|
|
// will cross the s_vpi_vecval boundary)
|
|
// it *may* work, but it is better to check first
|
|
assert(0);
|
|
|
|
// copy the remainder that did not fit in the previous s_vpi_vecval
|
|
offset -= BPW;
|
|
vec_val_ptr->aval |= (aval >> (darr_word_size - offset));
|
|
vec_val_ptr->bval |= (bval >> (darr_word_size - offset));
|
|
} else {
|
|
offset = 0;
|
|
}
|
|
}
|
|
|
|
bits_to_copy -= BPW;
|
|
darr_val.value.vector++;
|
|
}
|
|
}
|
|
|
|
darr_val.format = vpiVectorVal;
|
|
darr_val.value.vector = vec_val;
|
|
vpi_put_value(vec, &darr_val, 0, vpiNoDelay);
|
|
|
|
free(vec_val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static PLI_INT32 from_vec_calltf(ICARUS_VPI_CONST PLI_BYTE8*name)
|
|
{
|
|
vpiHandle callh = vpi_handle(vpiSysTfCall, 0);
|
|
vpiHandle argv = vpi_iterate(vpiArgument, callh);
|
|
vpiHandle darr = vpi_scan(argv);
|
|
vpiHandle vec = vpi_scan(argv);
|
|
s_vpi_value darr_val, vec_val;
|
|
s_vpi_vecval*vector;
|
|
|
|
vpi_free_object(argv);
|
|
|
|
int darr_size = vpi_get(vpiSize, darr);
|
|
int darr_word_size = vpi_get(vpiSize, vpi_handle_by_index(darr, 0));
|
|
int darr_bit_size = darr_size * darr_word_size;
|
|
|
|
int vec_size = vpi_get(vpiSize, vec);
|
|
if (vec_size <= 0) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s cannot cast an empty vector array.\n", name);
|
|
vpi_control(vpiFinish, 1);
|
|
return 0;
|
|
}
|
|
|
|
if (darr_bit_size != vec_size) {
|
|
vpi_printf("ERROR: %s:%d: ", vpi_get_str(vpiFile, callh),
|
|
(int)vpi_get(vpiLineNo, callh));
|
|
vpi_printf("%s dynamic array and vector size do not match "
|
|
"(%d != %d).\n", name, darr_bit_size, vec_size);
|
|
vpi_control(vpiFinish, 1);
|
|
return 0;
|
|
}
|
|
|
|
/* Conversion part */
|
|
int darr_number = (darr_word_size + BPWM1) / BPW;
|
|
vector = calloc(darr_number, sizeof(s_vpi_vecval));
|
|
|
|
vec_val.format = vpiVectorVal;
|
|
vpi_get_value(vec, &vec_val);
|
|
s_vpi_vecval*darr_val_ptr;
|
|
int offset = 0; // offset in bits
|
|
|
|
/* We have to reverse the order of the dynamic array, no memcpy here */
|
|
for(int i = darr_size - 1; i >= 0; --i) {
|
|
int bits_to_copy = darr_word_size;
|
|
vpiHandle darr_word = vpi_handle_by_index(darr, i);
|
|
assert(darr_val.value.vector);
|
|
darr_val_ptr = vector;
|
|
|
|
while(bits_to_copy > 0) {
|
|
int copied_bits = bits_to_copy > (int)BPW ? (int)BPW : bits_to_copy;
|
|
PLI_INT32 aval = vec_val.value.vector[offset / BPW].aval;
|
|
PLI_INT32 bval = vec_val.value.vector[offset / BPW].bval;
|
|
|
|
if(offset % BPW != 0) {
|
|
unsigned int rem_bits = offset % 32;
|
|
aval >>= rem_bits;
|
|
aval |= vec_val.value.vector[offset / BPW + 1].aval << (BPW - rem_bits);
|
|
bval >>= rem_bits;
|
|
bval |= vec_val.value.vector[offset / BPW + 1].bval << (BPW - rem_bits);
|
|
}
|
|
|
|
offset += copied_bits;
|
|
darr_val_ptr->aval = aval;
|
|
darr_val_ptr->bval = bval;
|
|
darr_val_ptr++;
|
|
bits_to_copy -= copied_bits;
|
|
}
|
|
|
|
darr_val.format = vpiVectorVal;
|
|
darr_val.value.vector = vector;
|
|
vpi_put_value(darr_word, &darr_val, 0, vpiNoDelay);
|
|
}
|
|
|
|
free(vector);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void sys_darray_register(void)
|
|
{
|
|
s_vpi_systf_data tf_data;
|
|
vpiHandle res;
|
|
|
|
tf_data.type = vpiSysFunc;
|
|
tf_data.sysfunctype = vpiIntFunc;
|
|
tf_data.tfname = "$size";
|
|
tf_data.calltf = dobject_size_calltf;
|
|
tf_data.compiletf = dobject_size_compiletf;
|
|
tf_data.sizetf = 0;
|
|
tf_data.user_data = "$size";
|
|
res = vpi_register_systf(&tf_data);
|
|
vpip_make_systf_system_defined(res);
|
|
|
|
tf_data.type = vpiSysTask;
|
|
tf_data.sysfunctype = 0;
|
|
tf_data.tfname = "$ivl_darray_method$to_vec";
|
|
tf_data.calltf = to_vec_calltf;
|
|
tf_data.compiletf = to_from_vec_compiletf;
|
|
tf_data.sizetf = 0;
|
|
tf_data.user_data = "$ivl_darray_method$to_vec";
|
|
res = vpi_register_systf(&tf_data);
|
|
vpip_make_systf_system_defined(res);
|
|
|
|
tf_data.type = vpiSysTask;
|
|
tf_data.sysfunctype = 0;
|
|
tf_data.tfname = "$ivl_darray_method$from_vec";
|
|
tf_data.calltf = from_vec_calltf;
|
|
tf_data.compiletf = to_from_vec_compiletf;
|
|
tf_data.sizetf = 0;
|
|
tf_data.user_data = "$ivl_darray_method$from_vec";
|
|
res = vpi_register_systf(&tf_data);
|
|
vpip_make_systf_system_defined(res);
|
|
|
|
}
|