build/sim/modules: add XGMII 10Gbps ethernet module
Used to simulate SoCs with XGMII 10Gbps ethernet and to do LiteEth verification
This commit is contained in:
Vamsi K Vytla
Florent Kermarrec
parent
56fbd2f250
commit
446ae57b75
|
|
@ -1,4 +1,4 @@
|
||||||
MODULES = ethernet serial2console serial2tcp clocker
|
MODULES = xgmii_ethernet ethernet serial2console serial2tcp clocker
|
||||||
SHROBJS = $(MODULES:=.so)
|
SHROBJS = $(MODULES:=.so)
|
||||||
|
|
||||||
.PHONY: $(MODULES)
|
.PHONY: $(MODULES)
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,17 @@
|
||||||
|
include ../variables.mak
|
||||||
|
CFLAGS += -Itapcfg/src/include
|
||||||
|
|
||||||
|
all: $(OBJ_DIR)/xgmii_ethernet.so
|
||||||
|
|
||||||
|
include ../rules.mak
|
||||||
|
|
||||||
|
OBJS = $(addprefix $(OBJ_DIR)/, xgmii_ethernet.o tapcfg.o taplog.o)
|
||||||
|
|
||||||
|
$(OBJ_DIR)/xgmii_ethernet.so: $(OBJS)
|
||||||
|
$(CC) $(LDFLAGS) -Wl,-soname,$@ -o $@ $^
|
||||||
|
|
||||||
|
$(OBJ_DIR)/tapcfg.o: tapcfg/src/lib/tapcfg.c
|
||||||
|
$(CC) $(CFLAGS) -c -o $@ $<
|
||||||
|
|
||||||
|
$(OBJ_DIR)/taplog.o: tapcfg/src/lib/taplog.c
|
||||||
|
$(CC) $(CFLAGS) -c -o $@ $<
|
||||||
|
|
@ -0,0 +1 @@
|
||||||
|
../ethernet/tapcfg/
|
||||||
|
|
@ -0,0 +1,387 @@
|
||||||
|
#include <assert.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include "error.h"
|
||||||
|
|
||||||
|
#include <event2/listener.h>
|
||||||
|
#include <event2/util.h>
|
||||||
|
#include <event2/event.h>
|
||||||
|
#include <json-c/json.h>
|
||||||
|
#include "tapcfg.h"
|
||||||
|
#include "modules.h"
|
||||||
|
|
||||||
|
#define ETH_LEN 9000
|
||||||
|
struct eth_packet_s {
|
||||||
|
char data[ETH_LEN];
|
||||||
|
size_t len;
|
||||||
|
struct eth_packet_s *next;
|
||||||
|
};
|
||||||
|
|
||||||
|
#define DW_64
|
||||||
|
struct session_s {
|
||||||
|
#ifdef DW_64
|
||||||
|
unsigned long int tx;
|
||||||
|
unsigned long int rx;
|
||||||
|
#else
|
||||||
|
unsigned int tx;
|
||||||
|
unsigned int rx;
|
||||||
|
#endif
|
||||||
|
char tx_valid;
|
||||||
|
char rx_valid;
|
||||||
|
char rx_ready;
|
||||||
|
|
||||||
|
#ifdef DW_64
|
||||||
|
unsigned long int *tx_data;
|
||||||
|
unsigned long int *rx_data;
|
||||||
|
#else
|
||||||
|
unsigned int *tx_data;
|
||||||
|
unsigned int *rx_data;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
char *tx_ctl;
|
||||||
|
char terminate;
|
||||||
|
char preamble;
|
||||||
|
char *rx_ctl;
|
||||||
|
char *sys_clk;
|
||||||
|
|
||||||
|
tapcfg_t *tapcfg;
|
||||||
|
int fd;
|
||||||
|
char databuf[ETH_LEN];
|
||||||
|
char rx_state;
|
||||||
|
int datalen;
|
||||||
|
char inbuf[ETH_LEN];
|
||||||
|
int inlen;
|
||||||
|
int insent;
|
||||||
|
struct eth_packet_s *ethpack;
|
||||||
|
struct event *ev;
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct event_base *base=NULL;
|
||||||
|
|
||||||
|
int litex_sim_module_get_args(char *args, char *arg, char **val)
|
||||||
|
{
|
||||||
|
int ret = RC_OK;
|
||||||
|
json_object *jsobj = NULL;
|
||||||
|
json_object *obj = NULL;
|
||||||
|
char *value = NULL;
|
||||||
|
int r;
|
||||||
|
|
||||||
|
jsobj = json_tokener_parse(args);
|
||||||
|
if(NULL == jsobj) {
|
||||||
|
fprintf(stderr, "Error parsing json arg: %s \n", args);
|
||||||
|
ret = RC_JSERROR;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(!json_object_is_type(jsobj, json_type_object)) {
|
||||||
|
fprintf(stderr, "Arg must be type object! : %s \n", args);
|
||||||
|
ret = RC_JSERROR;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
obj=NULL;
|
||||||
|
r = json_object_object_get_ex(jsobj, arg, &obj);
|
||||||
|
if(!r) {
|
||||||
|
fprintf(stderr, "Could not find object: \"%s\" (%s)\n", arg, args);
|
||||||
|
ret = RC_JSERROR;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
value = strdup(json_object_get_string(obj));
|
||||||
|
|
||||||
|
out:
|
||||||
|
*val = value;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int litex_sim_module_pads_get(struct pad_s *pads, char *name, void **signal)
|
||||||
|
{
|
||||||
|
int ret;
|
||||||
|
void *sig = NULL;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
if(!pads || !name || !signal) {
|
||||||
|
ret=RC_INVARG;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
i = 0;
|
||||||
|
while(pads[i].name) {
|
||||||
|
if(!strcmp(pads[i].name, name)) {
|
||||||
|
sig=(void*)pads[i].signal;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
i++;
|
||||||
|
}
|
||||||
|
|
||||||
|
out:
|
||||||
|
*signal=sig;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int xgmii_ethernet_start(void *b)
|
||||||
|
{
|
||||||
|
base = (struct event_base *) b;
|
||||||
|
printf("[xgmii_ethernet] loaded (%p)\n", base);
|
||||||
|
return RC_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
void event_handler(int fd, short event, void *arg)
|
||||||
|
{
|
||||||
|
struct session_s *s = (struct session_s*)arg;
|
||||||
|
struct eth_packet_s *ep;
|
||||||
|
struct eth_packet_s *tep;
|
||||||
|
|
||||||
|
if (event & EV_READ) {
|
||||||
|
ep = malloc(sizeof(struct eth_packet_s));
|
||||||
|
memset(ep, 0, sizeof(struct eth_packet_s));
|
||||||
|
ep->len = tapcfg_read(s->tapcfg, ep->data, ETH_LEN);
|
||||||
|
if(ep->len < 60)
|
||||||
|
ep->len = 60;
|
||||||
|
|
||||||
|
if(!s->ethpack)
|
||||||
|
s->ethpack = ep;
|
||||||
|
else {
|
||||||
|
for(tep=s->ethpack; tep->next; tep=tep->next);
|
||||||
|
tep->next = ep;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static const char macadr[6] = {0xaa, 0xb6, 0x24, 0x69, 0x77, 0x21};
|
||||||
|
|
||||||
|
static int xgmii_ethernet_new(void **sess, char *args)
|
||||||
|
{
|
||||||
|
int ret = RC_OK;
|
||||||
|
char *c_tap = NULL;
|
||||||
|
char *c_tap_ip = NULL;
|
||||||
|
struct session_s *s = NULL;
|
||||||
|
struct timeval tv = {10, 0};
|
||||||
|
if(!sess) {
|
||||||
|
ret = RC_INVARG;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
s=(struct session_s*)malloc(sizeof(struct session_s));
|
||||||
|
if(!s) {
|
||||||
|
ret=RC_NOENMEM;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
memset(s, 0, sizeof(struct session_s));
|
||||||
|
|
||||||
|
ret = litex_sim_module_get_args(args, "interface", &c_tap);
|
||||||
|
{
|
||||||
|
if(RC_OK != ret)
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
ret = litex_sim_module_get_args(args, "ip", &c_tap_ip);
|
||||||
|
{
|
||||||
|
if(RC_OK != ret)
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
s->tapcfg = tapcfg_init();
|
||||||
|
tapcfg_start(s->tapcfg, c_tap, 0);
|
||||||
|
s->fd = tapcfg_get_fd(s->tapcfg);
|
||||||
|
tapcfg_iface_set_hwaddr(s->tapcfg, macadr, 6);
|
||||||
|
tapcfg_iface_set_ipv4(s->tapcfg, c_tap_ip, 24);
|
||||||
|
tapcfg_iface_set_status(s->tapcfg, TAPCFG_STATUS_ALL_UP);
|
||||||
|
free(c_tap);
|
||||||
|
free(c_tap_ip);
|
||||||
|
|
||||||
|
s->ev = event_new(base, s->fd, EV_READ | EV_PERSIST, event_handler, s);
|
||||||
|
event_add(s->ev, &tv);
|
||||||
|
|
||||||
|
out:
|
||||||
|
*sess=(void*)s;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int xgmii_ethernet_add_pads(void *sess, struct pad_list_s *plist)
|
||||||
|
{
|
||||||
|
int ret=RC_OK;
|
||||||
|
struct session_s *s = (struct session_s*)sess;
|
||||||
|
struct pad_s *pads;
|
||||||
|
if(!sess || !plist) {
|
||||||
|
ret = RC_INVARG;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
pads = plist->pads;
|
||||||
|
if(!strcmp(plist->name, "eth")) {
|
||||||
|
litex_sim_module_pads_get(pads, "rx_data", (void**)&s->rx_data);
|
||||||
|
litex_sim_module_pads_get(pads, "rx_ctl", (void**)&s->rx_ctl);
|
||||||
|
litex_sim_module_pads_get(pads, "tx_data", (void**)&s->tx_data);
|
||||||
|
litex_sim_module_pads_get(pads, "tx_ctl", (void**)&s->tx_ctl);
|
||||||
|
}
|
||||||
|
|
||||||
|
if(!strcmp(plist->name, "sys_clk"))
|
||||||
|
litex_sim_module_pads_get(pads, "sys_clk", (void**)&s->sys_clk);
|
||||||
|
|
||||||
|
out:
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef DW_64
|
||||||
|
char g_preamble = 0;
|
||||||
|
char g_dw = 64;
|
||||||
|
unsigned long int g_mask = 0xff;
|
||||||
|
unsigned long int g_idle = 0x0707070707070707;
|
||||||
|
#else
|
||||||
|
char g_preamble = 0;
|
||||||
|
char g_dw = 32;
|
||||||
|
unsigned int g_mask = 0xff;
|
||||||
|
unsigned int g_idle = 0x07070707;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
static int xgmii_ethernet_tick(void *sess)
|
||||||
|
{
|
||||||
|
struct session_s *s = (struct session_s*)sess;
|
||||||
|
struct eth_packet_s *pep;
|
||||||
|
|
||||||
|
if(*s->sys_clk == 0) {
|
||||||
|
s->preamble=0;
|
||||||
|
return RC_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef DW_64
|
||||||
|
unsigned long int u;
|
||||||
|
#else
|
||||||
|
unsigned int u;
|
||||||
|
#endif
|
||||||
|
// XGMII stuff
|
||||||
|
u = *s->tx_data;
|
||||||
|
s->tx = u;
|
||||||
|
// printf("%16lx\t\t%x\n", u, *s->tx_ctl & g_mask);
|
||||||
|
if (u != g_idle) {
|
||||||
|
// printf("%16lx\t\t%x\n", u, *s->tx_ctl & g_mask);
|
||||||
|
// printf("preamble: %02x\n", g_preamble);
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((g_preamble == 0) && (*s->tx_ctl & g_mask) == 0x1) {
|
||||||
|
g_preamble = (g_dw == 64)? 2: 1;
|
||||||
|
} else if (g_preamble == 1) {
|
||||||
|
g_preamble = 2;
|
||||||
|
} else if (g_preamble == 2) {
|
||||||
|
if ((*s->tx_ctl & g_mask) != 0) {
|
||||||
|
// Intentionally ignoring errors for now (since we don't really have retransmission)
|
||||||
|
// So this means last word
|
||||||
|
// TODO: Check for end of frame mid word
|
||||||
|
for (int m = 0; m < (g_dw >> 3); m++) {
|
||||||
|
char mask = 1 << m;
|
||||||
|
if ((*s->tx_ctl & mask) == 0)
|
||||||
|
s->databuf[s->datalen++] = (char) ((u & (g_mask << (8*m))) >> (8*m));
|
||||||
|
}
|
||||||
|
|
||||||
|
// Enable for debugging
|
||||||
|
printf("Sending: \n");
|
||||||
|
for(int i=0; i < s->datalen; printf("%02x ", s->databuf[i++] & 0xff));
|
||||||
|
printf("\n%u\n", s->datalen);
|
||||||
|
printf("Sent %u\n", s->datalen);
|
||||||
|
tapcfg_write(s->tapcfg, s->databuf, s->datalen);
|
||||||
|
s->datalen=0;
|
||||||
|
g_preamble=0;
|
||||||
|
} else {
|
||||||
|
for (int i = 0; i < (g_dw >> 3); i++) {
|
||||||
|
assert(s->datalen <= ETH_LEN);
|
||||||
|
s->databuf[s->datalen++]= (char) ((u & (g_mask << (8 * i))) >> (8*i));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef DW_64
|
||||||
|
unsigned long int local_data = 0x0707070707070707;
|
||||||
|
unsigned long int temp_data = 0; // This is here just to avoid an ugly cast later
|
||||||
|
#else
|
||||||
|
unsigned int local_data = 0x07070707;
|
||||||
|
unsigned int temp_data = 0;
|
||||||
|
#endif
|
||||||
|
char temp_ctl = 0;
|
||||||
|
char local_ctl = 0;
|
||||||
|
if(s->inlen) {
|
||||||
|
// printf("%x ", s->rx_state);
|
||||||
|
if (s->rx_state == 0) {
|
||||||
|
*s->rx_data = 0xd5555555555555fb;
|
||||||
|
*s->rx_ctl = 1;
|
||||||
|
s->rx_state = 1;
|
||||||
|
} else if ((s->rx_state == 1) && (s->insent + (g_dw >> 3) < s->inlen)) {
|
||||||
|
*s->rx_ctl = 0;
|
||||||
|
local_data = 0;
|
||||||
|
for (unsigned int i = 0; i < (g_dw >> 3); i++) {
|
||||||
|
temp_data = (unsigned char) s->inbuf[s->insent++];
|
||||||
|
local_data |= (temp_data << (i << 3));
|
||||||
|
}
|
||||||
|
*s->rx_data = local_data;
|
||||||
|
} else if ((s->rx_state == 1) && (s->insent + (g_dw >> 3) >= s->inlen)) {
|
||||||
|
// printf("%d, %d\n", s->insent, s->inlen);
|
||||||
|
local_data = 0;
|
||||||
|
for (unsigned int i = 0; i < (g_dw >> 3); i++) {
|
||||||
|
if (s->insent < s->inlen) {
|
||||||
|
temp_data = (unsigned char) s->inbuf[s->insent++];
|
||||||
|
} else if (s->insent == s->inlen) {
|
||||||
|
temp_data = (unsigned char) 0xfd;
|
||||||
|
temp_ctl = 1;
|
||||||
|
s->insent++;
|
||||||
|
} else {
|
||||||
|
temp_data = (unsigned char) 0x07;
|
||||||
|
temp_ctl = 1;
|
||||||
|
s->insent++;
|
||||||
|
}
|
||||||
|
local_data |= (temp_data << (i << 3));
|
||||||
|
local_ctl |= (temp_ctl << i);
|
||||||
|
//printf("%16lx %02x\n", local_data, local_ctl);
|
||||||
|
}
|
||||||
|
*s->rx_data = local_data;
|
||||||
|
*s->rx_ctl = local_ctl;
|
||||||
|
if (s->insent == s->inlen)
|
||||||
|
s->rx_state = 2;
|
||||||
|
else {
|
||||||
|
s->insent = 0;
|
||||||
|
s->inlen = 0;
|
||||||
|
s->rx_state = 0;
|
||||||
|
}
|
||||||
|
} else if (s->rx_state == 2) {
|
||||||
|
*s->rx_ctl = 0xff;
|
||||||
|
*s->rx_data = 0x07070707070707fd;
|
||||||
|
s->insent =0;
|
||||||
|
s->inlen = 0;
|
||||||
|
s->rx_state = 0;
|
||||||
|
} else {
|
||||||
|
*s->rx_ctl = 0xff;
|
||||||
|
*s->rx_data = local_data;
|
||||||
|
}
|
||||||
|
// printf("%x, %16lx, %x\n", s->rx_state, *s->rx_data, *s->rx_ctl);
|
||||||
|
} else {
|
||||||
|
*s->rx_ctl = 0xff;
|
||||||
|
*s->rx_data = local_data;
|
||||||
|
if(s->ethpack) {
|
||||||
|
memcpy(s->inbuf, s->ethpack->data, s->ethpack->len);
|
||||||
|
printf("Received: %ld\n", s->ethpack->len );
|
||||||
|
for(int i=0; i< s->ethpack->len;) {
|
||||||
|
printf("%02x ", s->inbuf[i++] & 0xff);
|
||||||
|
if (i%8 == 0 && i > 0);
|
||||||
|
}
|
||||||
|
printf("\n");
|
||||||
|
s->inlen = s->ethpack->len;
|
||||||
|
pep=s->ethpack->next;
|
||||||
|
free(s->ethpack);
|
||||||
|
s->ethpack=pep;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return RC_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct ext_module_s ext_mod = {
|
||||||
|
"xgmii_ethernet",
|
||||||
|
xgmii_ethernet_start,
|
||||||
|
xgmii_ethernet_new,
|
||||||
|
xgmii_ethernet_add_pads,
|
||||||
|
NULL,
|
||||||
|
xgmii_ethernet_tick
|
||||||
|
};
|
||||||
|
|
||||||
|
int litex_sim_ext_module_init(int (*register_module)(struct ext_module_s *))
|
||||||
|
{
|
||||||
|
int ret = RC_OK;
|
||||||
|
ret = register_module(&ext_mod);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
@ -206,7 +206,8 @@ class SimVerilatorToolchain:
|
||||||
# run
|
# run
|
||||||
if run:
|
if run:
|
||||||
_compile_sim(build_name, verbose)
|
_compile_sim(build_name, verbose)
|
||||||
_run_sim(build_name, as_root=sim_config.has_module("ethernet"))
|
_run_sim(build_name, as_root=sim_config.has_module("ethernet") or
|
||||||
|
sim_config.has_module("xgmii_ethernet"))
|
||||||
|
|
||||||
os.chdir("../../")
|
os.chdir("../../")
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue