From 86dc60b9808d3aac70eccda80607a91ffd2e5292 Mon Sep 17 00:00:00 2001 From: Ivo Timmermans Date: Tue, 9 Apr 2002 15:32:14 +0000 Subject: [PATCH] Ok, I forgot these ;) --- src/freebsd/device.c | 148 ++++++++++++++++++++++++++++ src/linux/device.c | 224 +++++++++++++++++++++++++++++++++++++++++++ src/netbsd/device.c | 164 +++++++++++++++++++++++++++++++ src/openbsd/device.c | 195 +++++++++++++++++++++++++++++++++++++ src/solaris/device.c | 196 +++++++++++++++++++++++++++++++++++++ 5 files changed, 927 insertions(+) create mode 100644 src/freebsd/device.c create mode 100644 src/linux/device.c create mode 100644 src/netbsd/device.c create mode 100644 src/openbsd/device.c create mode 100644 src/solaris/device.c diff --git a/src/freebsd/device.c b/src/freebsd/device.c new file mode 100644 index 00000000..39f9df50 --- /dev/null +++ b/src/freebsd/device.c @@ -0,0 +1,148 @@ +/* + device.c -- Interaction with FreeBSD tap device + Copyright (C) 2001-2002 Ivo Timmermans , + 2001-2002 Guus Sliepen + + This program is free software; you can redistribute it and/or modify + it 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., 675 Mass Ave, Cambridge, MA 02139, USA. + + $Id: device.c,v 1.2 2002/04/09 15:32:14 zarq Exp $ +*/ + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include "conf.h" +#include "net.h" +#include "subnet.h" + +#include "system.h" + +#define DEFAULT_DEVICE "/dev/tap0" + +int device_fd = -1; +int device_type; +char *device; +char *interface; +char *device_info; +int device_total_in = 0; +int device_total_out = 0; + +extern subnet_t mymac; + +/* + open the local ethertap device +*/ +int setup_device(void) +{ +cp + if(!get_config_string(lookup_config(config_tree, "Device"), &device)) + device = DEFAULT_DEVICE; + + if(!get_config_string(lookup_config(config_tree, "Interface"), &interface)) + interface = rindex(device, '/')?rindex(device, '/')+1:device; +cp + if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0) + { + syslog(LOG_ERR, _("Could not open %s: %s"), device, strerror(errno)); + return -1; + } +cp + + /* Set default MAC address for ethertap devices */ + + mymac.type = SUBNET_MAC; + mymac.net.mac.address.x[0] = 0xfe; + mymac.net.mac.address.x[1] = 0xfd; + mymac.net.mac.address.x[2] = 0x00; + mymac.net.mac.address.x[3] = 0x00; + mymac.net.mac.address.x[4] = 0x00; + mymac.net.mac.address.x[5] = 0x00; + + device_info = _("FreeBSD tap device"); + + syslog(LOG_INFO, _("%s is a %s"), device, device_info); +cp + return 0; +} + +void close_device(void) +{ +cp + close(device_fd); +} + +/* + read, encrypt and send data that is + available through the ethertap device +*/ +int read_packet(vpn_packet_t *packet) +{ + int lenin; +cp + if((lenin = read(device_fd, packet->data, MTU)) <= 0) + { + syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + packet->len = lenin; + + device_total_in += packet->len; + + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), + packet->len, device_info); + + return 0; +cp +} + +int write_packet(vpn_packet_t *packet) +{ +cp + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"), + packet->len, device_info); + + if(write(device_fd, packet->data, packet->len) < 0) + { + syslog(LOG_ERR, _("Error while writing to %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + device_total_out += packet->len; +cp +} + +void dump_device_stats(void) +{ +cp + syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device); + syslog(LOG_DEBUG, _(" total bytes in: %10d"), device_total_in); + syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out); +cp +} diff --git a/src/linux/device.c b/src/linux/device.c new file mode 100644 index 00000000..09028dee --- /dev/null +++ b/src/linux/device.c @@ -0,0 +1,224 @@ +/* + device.c -- Interaction with Linux ethertap and tun/tap device + Copyright (C) 2001-2002 Ivo Timmermans , + 2001-2002 Guus Sliepen + + This program is free software; you can redistribute it and/or modify + it 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., 675 Mass Ave, Cambridge, MA 02139, USA. + + $Id: device.c,v 1.2 2002/04/09 15:32:14 zarq Exp $ +*/ + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#ifdef HAVE_TUNTAP + #ifdef LINUX_IF_TUN_H + #include LINUX_IF_TUN_H + #else + #include + #endif + #define DEFAULT_DEVICE "/dev/misc/net/tun" +#else + #define DEFAULT_DEVICE "/dev/tap0" +#endif + +#include +#include "conf.h" +#include "net.h" +#include "subnet.h" + +#include "system.h" + +#define DEVICE_TYPE_ETHERTAP 0 +#define DEVICE_TYPE_TUNTAP 1 + +int device_fd = -1; +int device_type; +char *device; +char *interface; +char ifrname[IFNAMSIZ]; +char *device_info; + +int device_total_in = 0; +int device_total_out = 0; + +extern subnet_t mymac; + +/* + open the local ethertap device +*/ +int setup_device(void) +{ + struct ifreq ifr; + +cp + if(!get_config_string(lookup_config(config_tree, "Device"), &device)) + device = DEFAULT_DEVICE; + + if(!get_config_string(lookup_config(config_tree, "Interface"), &interface)) +#ifdef HAVE_TUNTAP + interface = netname; +#else + interface = rindex(device, '/')?rindex(device, '/')+1:device; +#endif +cp + if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0) + { + syslog(LOG_ERR, _("Could not open %s: %s"), device, strerror(errno)); + return -1; + } +cp + /* Set default MAC address for ethertap devices */ + + mymac.type = SUBNET_MAC; + mymac.net.mac.address.x[0] = 0xfe; + mymac.net.mac.address.x[1] = 0xfd; + mymac.net.mac.address.x[2] = 0x00; + mymac.net.mac.address.x[3] = 0x00; + mymac.net.mac.address.x[4] = 0x00; + mymac.net.mac.address.x[5] = 0x00; + +#ifdef HAVE_TUNTAP + /* Ok now check if this is an old ethertap or a new tun/tap thingie */ + + memset(&ifr, 0, sizeof(ifr)); +cp + ifr.ifr_flags = IFF_TAP | IFF_NO_PI; + if (interface) + strncpy(ifr.ifr_name, interface, IFNAMSIZ); +cp + if (!ioctl(device_fd, TUNSETIFF, (void *) &ifr)) + { + device_info = _("Linux tun/tap device"); + device_type = DEVICE_TYPE_TUNTAP; + strncpy(ifrname, ifr.ifr_name, IFNAMSIZ); + interface = ifrname; + } + else + if (!ioctl(device_fd, (('T'<< 8) | 202), (void *) &ifr)) + { + syslog(LOG_WARNING, _("Old ioctl() request was needed for %s"), device); + device_type = DEVICE_TYPE_TUNTAP; + device_info = _("Linux tun/tap device"); + strncpy(ifrname, ifr.ifr_name, IFNAMSIZ); + interface = ifrname; + } + else +#endif + { + device_info = _("Linux ethertap device"); + device_type = DEVICE_TYPE_ETHERTAP; + interface = rindex(device, '/')?rindex(device, '/')+1:device; + } + + syslog(LOG_INFO, _("%s is a %s"), device, device_info); +cp + return 0; +} + +void close_device(void) +{ +cp + close(device_fd); +} + +/* + read, encrypt and send data that is + available through the ethertap device +*/ +int read_packet(vpn_packet_t *packet) +{ + int lenin; +cp + if(device_type == DEVICE_TYPE_TUNTAP) + { + if((lenin = read(device_fd, packet->data, MTU)) <= 0) + { + syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + packet->len = lenin; + } + else /* ethertap */ + { + if((lenin = read(device_fd, packet->data - 2, MTU + 2)) <= 0) + { + syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + packet->len = lenin - 2; + } + + device_total_in += packet->len; + + if(debug_lvl >= DEBUG_TRAFFIC) + { + syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len, device_info); + } + + return 0; +cp +} + +int write_packet(vpn_packet_t *packet) +{ +cp + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"), + packet->len, device_info); + + if(device_type == DEVICE_TYPE_TUNTAP) + { + if(write(device_fd, packet->data, packet->len) < 0) + { + syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + } + else/* ethertap */ + { + *(short int *)(packet->data - 2) = packet->len; + if(write(device_fd, packet->data - 2, packet->len + 2) < 0) + { + syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + } + + device_total_out += packet->len; +cp + return 0; +} + +void dump_device_stats(void) +{ +cp + syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device); + syslog(LOG_DEBUG, _(" total bytes in: %10d"), device_total_in); + syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out); +cp +} diff --git a/src/netbsd/device.c b/src/netbsd/device.c new file mode 100644 index 00000000..996dd875 --- /dev/null +++ b/src/netbsd/device.c @@ -0,0 +1,164 @@ +/* + device.c -- Interaction with NetBSD tun device + Copyright (C) 2001-2002 Ivo Timmermans , + 2001-2002 Guus Sliepen + + This program is free software; you can redistribute it and/or modify + it 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., 675 Mass Ave, Cambridge, MA 02139, USA. + + $Id: device.c,v 1.2 2002/04/09 15:32:14 zarq Exp $ +*/ + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include "conf.h" +#include "net.h" +#include "subnet.h" + +#include "system.h" + +#define DEFAULT_DEVICE "/dev/tun0" + +#define DEVICE_TYPE_ETHERTAP 0 +#define DEVICE_TYPE_TUNTAP 1 + +int device_fd = -1; +int device_type; +char *device; +char *interface; +char *device_info; + +int device_total_in = 0; +int device_total_out = 0; + +extern subnet_t mymac; + +/* + open the local ethertap device +*/ +int setup_device(void) +{ + if(!get_config_string(lookup_config(config_tree, "Device"), &device)) + device = DEFAULT_DEVICE; + + if(!get_config_string(lookup_config(config_tree, "Interface"), &interface)) + interface = rindex(device, '/')?rindex(device, '/')+1:device; +cp + if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0) + { + syslog(LOG_ERR, _("Could not open %s: %s"), device, strerror(errno)); + return -1; + } +cp + /* Set default MAC address for ethertap devices */ + + mymac.type = SUBNET_MAC; + mymac.net.mac.address.x[0] = 0xfe; + mymac.net.mac.address.x[1] = 0xfd; + mymac.net.mac.address.x[2] = 0x00; + mymac.net.mac.address.x[3] = 0x00; + mymac.net.mac.address.x[4] = 0x00; + mymac.net.mac.address.x[5] = 0x00; + + device_info = _("NetBSD tun device"); + + syslog(LOG_INFO, _("%s is a %s"), device, device_info); +cp + return 0; +} + +void close_device(void) +{ +cp + close(device_fd); +cp +} + +int read_packet(vpn_packet_t *packet) +{ + int lenin; + u_int32_t type; + struct iovec vector[2] = {{&type, sizeof(type)}, {packet->data + 14, MTU - 14}}; +cp + + if((lenin = readv(device_fd, vector, 2)) <= 0) + { + syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + memcpy(packet->data, mymac.net.mac.address.x, 6); + memcpy(packet->data + 6, mymac.net.mac.address.x, 6); + packet->data[12] = 0x08; + packet->data[13] = 0x00; + + packet->len = lenin + 10; + + device_total_in += packet->len; + + if(debug_lvl >= DEBUG_TRAFFIC) + { + syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len, device_info); + } + + return 0; +cp +} + +int write_packet(vpn_packet_t *packet) +{ + u_int32_t type = htonl(AF_INET); + struct iovec vector[2]; +cp + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"), + packet->len, device_info); + + vector[0].iov_base = &type; + vector[0].iov_len = sizeof(type); + vector[1].iov_base = packet->data + 14; + vector[1].iov_len = packet->len - 14; + + if(writev(device_fd, vector, 2) < 0) + { + syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + device_total_out += packet->len; +cp +} + +void dump_device_stats(void) +{ +cp + syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device); + syslog(LOG_DEBUG, _(" total bytes in: %10d"), device_total_in); + syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out); +cp +} diff --git a/src/openbsd/device.c b/src/openbsd/device.c new file mode 100644 index 00000000..7f20a950 --- /dev/null +++ b/src/openbsd/device.c @@ -0,0 +1,195 @@ +/* + device.c -- Interaction with OpenBSD tun device + Copyright (C) 2001-2002 Ivo Timmermans , + 2001-2002 Guus Sliepen + + This program is free software; you can redistribute it and/or modify + it 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., 675 Mass Ave, Cambridge, MA 02139, USA. + + $Id: device.c,v 1.2 2002/04/09 15:32:14 zarq Exp $ +*/ + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include "conf.h" +#include "net.h" +#include "subnet.h" + +#include "system.h" + +#define DEFAULT_DEVICE "/dev/tun0" + +#define DEVICE_TYPE_ETHERTAP 0 +#define DEVICE_TYPE_TUNTAP 1 + +int device_fd = -1; +int device_type; +char *device; +char *interface; +char *device_info; + +int device_total_in = 0; +int device_total_out = 0; + +extern subnet_t mymac; + +/* + open the local ethertap device +*/ +int setup_device(void) +{ + if(!get_config_string(lookup_config(config_tree, "Device"), &device)) + device = DEFAULT_DEVICE; + + if(!get_config_string(lookup_config(config_tree, "Interface"), &interface)) + interface = rindex(device, '/')?rindex(device, '/')+1:device; +cp + if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0) + { + syslog(LOG_ERR, _("Could not open %s: %s"), device, strerror(errno)); + return -1; + } +cp + /* Set default MAC address for ethertap devices */ + + mymac.type = SUBNET_MAC; + mymac.net.mac.address.x[0] = 0xfe; + mymac.net.mac.address.x[1] = 0xfd; + mymac.net.mac.address.x[2] = 0x00; + mymac.net.mac.address.x[3] = 0x00; + mymac.net.mac.address.x[4] = 0x00; + mymac.net.mac.address.x[5] = 0x00; + + device_info = _("OpenBSD tun device"); + + syslog(LOG_INFO, _("%s is a %s"), device, device_info); +cp + return 0; +} + +void close_device(void) +{ +cp + close(device_fd); +cp +} + +int read_packet(vpn_packet_t *packet) +{ + int lenin; + u_int32_t type; + struct iovec vector[2] = {{&type, sizeof(type)}, {packet->data + 14, MTU - 14}}; +cp + + if((lenin = readv(device_fd, vector, 2)) <= 0) + { + syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + memcpy(packet->data, mymac.net.mac.address.x, 6); + memcpy(packet->data + 6, mymac.net.mac.address.x, 6); + + switch(ntohl(type)) + { + case AF_INET: + packet->data[12] = 0x8; + packet->data[13] = 0x0; + break; + case AF_INET6: + packet->data[12] = 0x86; + packet->data[13] = 0xDD; + break; + default: + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_ERR, _("Unknown address family %d while reading packet from %s %s"), ntohl(type), device_info, device); + return -1; + } + + packet->len = lenin + 10; + + device_total_in += packet->len; + + if(debug_lvl >= DEBUG_TRAFFIC) + { + syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len, device_info); + } + + return 0; +cp +} + +int write_packet(vpn_packet_t *packet) +{ + u_int32_t type; + struct iovec vector[2]; + int af; +cp + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"), + packet->len, device_info); + + af = (packet->data[12] << 8) + packet->data[13]; + + switch(af) + { + case 0x800: + type = htonl(AF_INET); + break; + case 0x86DD: + type = htonl(AF_INET6); + break; + default: + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_ERR, _("Unknown address family %d while writing packet to %s %s"), af, device_info, device); + return -1; + } + + vector[0].iov_base = &type; + vector[0].iov_len = sizeof(type); + vector[1].iov_base = packet->data + 14; + vector[1].iov_len = packet->len - 14; + + if(writev(device_fd, vector, 2) < 0) + { + syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + device_total_out += packet->len; +cp +} + +void dump_device_stats(void) +{ +cp + syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device); + syslog(LOG_DEBUG, _(" total bytes in: %10d"), device_total_in); + syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out); +cp +} diff --git a/src/solaris/device.c b/src/solaris/device.c new file mode 100644 index 00000000..1375d1f2 --- /dev/null +++ b/src/solaris/device.c @@ -0,0 +1,196 @@ +/* + device.c -- Interaction with Solaris tun device + Copyright (C) 2001-2002 Ivo Timmermans , + 2001-2002 Guus Sliepen + + This program is free software; you can redistribute it and/or modify + it 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., 675 Mass Ave, Cambridge, MA 02139, USA. + + $Id: device.c,v 1.2 2002/04/09 15:32:14 zarq Exp $ +*/ + + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define DEFAULT_DEVICE "/dev/tun" + +#include +#include "conf.h" +#include "net.h" +#include "subnet.h" + +#include "system.h" + +int device_fd = -1; +int device_type; +char *device = NULL; +char *interface = NULL; +char ifrname[IFNAMSIZ]; +char *device_info = NULL; + +int device_total_in = 0; +int device_total_out = 0; + +subnet_t mymac; + +int setup_device(void) +{ + int ip_fd = -1, if_fd = -1; + int ppa; + char *ptr; + +cp + if(!get_config_string(lookup_config(config_tree, "Device"), &device)) + device = DEFAULT_DEVICE; + +cp + if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0) + { + syslog(LOG_ERR, _("Could not open %s: %s"), device, strerror(errno)); + return -1; + } +cp + ppa = 0; + + ptr = device; + while(*ptr && !isdigit((int)*ptr)) ptr++; + ppa = atoi(ptr); + + if( (ip_fd = open("/dev/ip", O_RDWR, 0)) < 0){ + syslog(LOG_ERR, _("Could not open /dev/ip: %s"), strerror(errno)); + return -1; + } + + /* Assign a new PPA and get its unit number. */ + if( (ppa = ioctl(device_fd, TUNNEWPPA, ppa)) < 0){ + syslog(LOG_ERR, _("Can't assign new interface: %s"), strerror(errno)); + return -1; + } + + if( (if_fd = open(device, O_RDWR, 0)) < 0){ + syslog(LOG_ERR, _("Could not open %s twice: %s"), device, strerror(errno)); + return -1; + } + + if(ioctl(if_fd, I_PUSH, "ip") < 0){ + syslog(LOG_ERR, _("Can't push IP module: %s"), strerror(errno)); + return -1; + } + + /* Assign ppa according to the unit number returned by tun device */ + if(ioctl(if_fd, IF_UNITSEL, (char *)&ppa) < 0){ + syslog(LOG_ERR, _("Can't set PPA %d: %s"), ppa, strerror(errno)); + return -1; + } + + if(ioctl(ip_fd, I_LINK, if_fd) < 0){ + syslog(LOG_ERR, _("Can't link TUN device to IP: %s"), strerror(errno)); + return -1; + } + + if(!get_config_string(lookup_config(config_tree, "Interface"), &interface)) + asprintf(&interface, "tun%d", ppa); + + device_info = _("Solaris tun device"); + + /* Set default MAC address for ethertap devices */ + + mymac.type = SUBNET_MAC; + mymac.net.mac.address.x[0] = 0xfe; + mymac.net.mac.address.x[1] = 0xfd; + mymac.net.mac.address.x[2] = 0x00; + mymac.net.mac.address.x[3] = 0x00; + mymac.net.mac.address.x[4] = 0x00; + mymac.net.mac.address.x[5] = 0x00; + + syslog(LOG_INFO, _("%s is a %s"), device, device_info); +cp + return 0; +} + +void close_device(void) +{ +cp + close(device_fd); +} + +int read_packet(vpn_packet_t *packet) +{ + int lenin; +cp + if((lenin = read(device_fd, packet->data + 14, MTU - 14)) <= 0) + { + syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno)); + return -1; + } + + memcpy(packet->data, mymac.net.mac.address.x, 6); + memcpy(packet->data + 6, mymac.net.mac.address.x, 6); + packet->data[12] = 0x08; + packet->data[13] = 0x00; + + packet->len = lenin + 14; + + device_total_in += packet->len; + + if(debug_lvl >= DEBUG_TRAFFIC) + { + syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len, device_info); + } + + return 0; +cp +} + +int write_packet(vpn_packet_t *packet) +{ +cp + if(debug_lvl >= DEBUG_TRAFFIC) + syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"), + packet->len, device_info); + + if(write(device_fd, packet->data + 14, packet->len - 14) < 0) + { + syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, packet->len, strerror(errno)); + return -1; + } + + device_total_out += packet->len; +cp + return 0; +} + +void dump_device_stats(void) +{ +cp + syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device); + syslog(LOG_DEBUG, _(" total bytes in: %10d"), device_total_in); + syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out); +cp +} -- 2.20.1