123 lines
3.2 KiB
C
123 lines
3.2 KiB
C
/*********************************************************************
|
|
PicoTCP. Copyright (c) 2012-2017 Altran Intelligent Systems. Some rights reserved.
|
|
See COPYING, LICENSE.GPLv2 and LICENSE.GPLv3 for usage.
|
|
|
|
Authors: Daniele Lacamera
|
|
*********************************************************************/
|
|
|
|
#ifndef UNIT_TEST
|
|
#include <libvdeplug.h>
|
|
#endif
|
|
#include "pico_device.h"
|
|
#include "pico_dev_vde.h"
|
|
#include "pico_stack.h"
|
|
|
|
#include <sys/poll.h>
|
|
|
|
struct pico_device_vde {
|
|
struct pico_device dev;
|
|
char *sock;
|
|
VDECONN *conn;
|
|
uint32_t counter_in;
|
|
uint32_t counter_out;
|
|
uint32_t lost_in;
|
|
uint32_t lost_out;
|
|
};
|
|
|
|
#define VDE_MTU 65536
|
|
|
|
/* Mockables */
|
|
#if defined UNIT_TEST
|
|
# define MOCKABLE __attribute__((weak))
|
|
#else
|
|
# define MOCKABLE
|
|
#endif
|
|
|
|
static int pico_vde_send(struct pico_device *dev, void *buf, int len)
|
|
{
|
|
struct pico_device_vde *vde = (struct pico_device_vde *) dev;
|
|
/* dbg("[%s] send %d bytes.\n", dev->name, len); */
|
|
if ((vde->lost_out == 0) || ((pico_rand() % 100) > vde->lost_out))
|
|
return (int)vde_send(vde->conn, buf, (uint32_t)len, 0);
|
|
else
|
|
return len; /* Silently discarded "on the wire" */
|
|
|
|
}
|
|
|
|
static int pico_vde_poll(struct pico_device *dev, int loop_score)
|
|
{
|
|
struct pico_device_vde *vde = (struct pico_device_vde *) dev;
|
|
struct pollfd pfd;
|
|
unsigned char buf[VDE_MTU];
|
|
int len;
|
|
pfd.fd = vde_datafd(vde->conn);
|
|
pfd.events = POLLIN;
|
|
do {
|
|
if (poll(&pfd, 1, 0) <= 0)
|
|
return loop_score;
|
|
|
|
len = (int)vde_recv(vde->conn, buf, VDE_MTU, 0);
|
|
if (len > 0) {
|
|
/* dbg("Received pkt.\n"); */
|
|
if ((vde->lost_in == 0) || ((pico_rand() % 100) > vde->lost_in)) {
|
|
loop_score--;
|
|
pico_stack_recv(dev, buf, (uint32_t)len);
|
|
}
|
|
}
|
|
} while(loop_score > 0);
|
|
return 0;
|
|
}
|
|
|
|
/* Public interface: create/destroy. */
|
|
|
|
void pico_vde_destroy(struct pico_device *dev)
|
|
{
|
|
struct pico_device_vde *vde = (struct pico_device_vde *) dev;
|
|
vde_close(vde->conn);
|
|
usleep(100000);
|
|
sync();
|
|
}
|
|
|
|
void pico_vde_set_packetloss(struct pico_device *dev, uint32_t in_pct, uint32_t out_pct)
|
|
{
|
|
struct pico_device_vde *vde = (struct pico_device_vde *) dev;
|
|
vde->lost_in = in_pct;
|
|
vde->lost_out = out_pct;
|
|
}
|
|
|
|
|
|
|
|
struct pico_device *MOCKABLE pico_vde_create(char *sock, char *name, uint8_t *mac)
|
|
{
|
|
struct pico_device_vde *vde = PICO_ZALLOC(sizeof(struct pico_device_vde));
|
|
struct vde_open_args open_args = {
|
|
.mode = 0700
|
|
};
|
|
char vdename[] = "picotcp";
|
|
|
|
if (!vde)
|
|
return NULL;
|
|
|
|
if( 0 != pico_device_init((struct pico_device *)vde, name, mac)) {
|
|
dbg ("Vde init failed.\n");
|
|
pico_vde_destroy((struct pico_device *)vde);
|
|
return NULL;
|
|
}
|
|
|
|
vde->dev.overhead = 0;
|
|
vde->sock = PICO_ZALLOC(strlen(sock) + 1);
|
|
memcpy(vde->sock, sock, strlen(sock));
|
|
vde->conn = vde_open(sock, vdename, &open_args);
|
|
if (!vde->conn) {
|
|
pico_vde_destroy((struct pico_device *)vde);
|
|
return NULL;
|
|
}
|
|
|
|
vde->dev.send = pico_vde_send;
|
|
vde->dev.poll = pico_vde_poll;
|
|
vde->dev.destroy = pico_vde_destroy;
|
|
dbg("Device %s created.\n", vde->dev.name);
|
|
return (struct pico_device *)vde;
|
|
}
|
|
|