forked from cores/microwatt
Consolidate VHPI code
We had many copies of the VHPI marshalling/unmarshalling code. Signed-off-by: Anton Blanchard <anton@linux.ibm.com>jtag-port
parent
6a9bc46fcb
commit
471c7e2197
@ -0,0 +1,84 @@
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include "sim_vhpi_c.h"
|
||||
|
||||
struct int_bounds
|
||||
{
|
||||
int left;
|
||||
int right;
|
||||
char dir;
|
||||
unsigned int len;
|
||||
};
|
||||
|
||||
struct fat_pointer
|
||||
{
|
||||
void *base;
|
||||
struct int_bounds *bounds;
|
||||
};
|
||||
|
||||
char *from_string(void *__p)
|
||||
{
|
||||
struct fat_pointer *p = __p;
|
||||
unsigned long len = p->bounds->len;
|
||||
char *m;
|
||||
|
||||
m = malloc(len+1);
|
||||
if (!m) {
|
||||
perror("malloc");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
memcpy(m, p->base, len);
|
||||
m[len] = 0x0;
|
||||
|
||||
return m;
|
||||
}
|
||||
|
||||
uint64_t from_std_logic_vector(unsigned char *p, unsigned long len)
|
||||
{
|
||||
unsigned long ret = 0;
|
||||
|
||||
if (len > 64) {
|
||||
fprintf(stderr, "%s: invalid length %lu\n", __func__, len);
|
||||
exit(1);
|
||||
}
|
||||
|
||||
for (unsigned long i = 0; i < len; i++) {
|
||||
unsigned char bit;
|
||||
|
||||
if (*p == vhpi0) {
|
||||
bit = 0;
|
||||
} else if (*p == vhpi1) {
|
||||
bit = 1;
|
||||
} else {
|
||||
fprintf(stderr, "%s: bad bit %d\n", __func__, *p);
|
||||
bit = 0;
|
||||
}
|
||||
|
||||
ret = (ret << 1) | bit;
|
||||
p++;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
void to_std_logic_vector(unsigned long val, unsigned char *p,
|
||||
unsigned long len)
|
||||
{
|
||||
if (len > 64) {
|
||||
fprintf(stderr, "%s: invalid length %lu\n", __func__, len);
|
||||
exit(1);
|
||||
}
|
||||
|
||||
for (unsigned long i = 0; i < len; i++) {
|
||||
if ((val >> (len-1-i) & 1))
|
||||
*p = vhpi1;
|
||||
else
|
||||
*p = vhpi0;
|
||||
|
||||
p++;
|
||||
}
|
||||
}
|
@ -0,0 +1,11 @@
|
||||
#include <stdint.h>
|
||||
|
||||
#define vhpi0 2 /* forcing 0 */
|
||||
#define vhpi1 3 /* forcing 1 */
|
||||
|
||||
char *from_string(void *__p);
|
||||
|
||||
uint64_t from_std_logic_vector(unsigned char *p, unsigned long len);
|
||||
|
||||
void to_std_logic_vector(unsigned long val, unsigned char *p,
|
||||
unsigned long len);
|
Loading…
Reference in New Issue