src/raw_socket/device.c

   1 /*
   2     device.c -- raw socket
   3     Copyright (C) 2002 Ivo Timmermans <ivo@o2w.nl>,
   4                   2002 Guus Sliepen <guus@sliepen.eu.org>
   5
   6     This program is free software; you can redistribute it and/or modify
   7     it under the terms of the GNU General Public License as published by
   8     the Free Software Foundation; either version 2 of the License, or
   9     (at your option) any later version.
  10
  11     This program is distributed in the hope that it will be useful,
  12     but WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14     GNU General Public License for more details.
  15
  16     You should have received a copy of the GNU General Public License
  17     along with this program; if not, write to the Free Software
  18     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19
  20     $Id: device.c,v 1.1.2.4 2002/09/10 21:29:42 guus Exp $
  21 */
  22
  23 #include "config.h"
  24
  25 #include <stdio.h>
  26 #include <errno.h>
  27 #include <sys/types.h>
  28 #include <sys/stat.h>
  29 #include <fcntl.h>
  30 #include <net/if.h>
  31 #include <unistd.h>
  32 #include <syslog.h>
  33 #include <string.h>
  34 #include <sys/ioctl.h>
  35 #include <sys/socket.h>
  36 #include <netpacket/packet.h>
  37 #include <net/ethernet.h>
  38
  39 #include <utils.h>
  40 #include "conf.h"
  41 #include "net.h"
  42 #include "subnet.h"
  43
  44 #include "system.h"
  45
  46 int device_fd = -1;
  47 int device_type;
  48 char *device;
  49 char *interface;
  50 char ifrname[IFNAMSIZ];
  51 char *device_info;
  52
  53 int device_total_in = 0;
  54 int device_total_out = 0;
  55
  56 extern subnet_t mymac;
  57
  58 /*
  59   open the local ethertap device
  60 */
  61 int setup_device(void)
  62 {
  63         struct ifreq ifr;
  64         struct sockaddr_ll sa;
  65
  66         cp();
  67
  68         if(!get_config_string
  69                   (lookup_config(config_tree, "Interface"), &interface))
  70                 interface = "eth0";
  71
  72         if(!get_config_string(lookup_config(config_tree, "Device"), &device))
  73                 device = interface;
  74
  75         device_info = _("raw socket");
  76
  77         if((device_fd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL))) < 0) {
  78                 syslog(LOG_ERR, _("Could not open %s: %s"), device_info,
  79                            strerror(errno));
  80                 return -1;
  81         }
  82
  83         memset(&ifr, 0, sizeof(ifr));
  84         strncpy(ifr.ifr_ifrn.ifrn_name, interface, IFNAMSIZ);
  85         if(ioctl(device_fd, SIOCGIFINDEX, &ifr)) {
  86                 close(device_fd);
  87                 syslog(LOG_ERR, _("Can't find interface %s: %s"), interface,
  88                            strerror(errno));
  89                 return -1;
  90         }
  91
  92         memset(&sa, '0', sizeof(sa));
  93         sa.sll_family = AF_PACKET;
  94         sa.sll_protocol = htons(ETH_P_ALL);
  95         sa.sll_ifindex = ifr.ifr_ifindex;
  96
  97         if(bind(device_fd, (struct sockaddr *) &sa, (socklen_t) sizeof(sa))) {
  98                 syslog(LOG_ERR, _("Could not bind to %s: %s"), device, strerror(errno));
  99                 return -1;
 100         }
 101
 102         /* Set default MAC address for ethertap devices */
 103         mymac.type = SUBNET_MAC;
 104         mymac.net.mac.address.x[0] = 0xfe;
 105         mymac.net.mac.address.x[1] = 0xfd;
 106         mymac.net.mac.address.x[2] = 0x00;
 107         mymac.net.mac.address.x[3] = 0x00;
 108         mymac.net.mac.address.x[4] = 0x00;
 109         mymac.net.mac.address.x[5] = 0x00;
 110
 111         syslog(LOG_INFO, _("%s is a %s"), device, device_info);
 112
 113         return 0;
 114 }
 115
 116 void close_device(void)
 117 {
 118         cp();
 119
 120         close(device_fd);
 121 }
 122
 123 /*
 124   read, encrypt and send data that is
 125   available through the ethertap device
 126 */
 127 int read_packet(vpn_packet_t *packet)
 128 {
 129         int lenin;
 130
 131         cp();
 132
 133         if((lenin = read(device_fd, packet->data, MTU)) <= 0) {
 134                 syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info,
 135                            device, strerror(errno));
 136                 return -1;
 137         }
 138
 139         packet->len = lenin;
 140
 141         device_total_in += packet->len;
 142
 143         if(debug_lvl >= DEBUG_TRAFFIC) {
 144                 syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len,
 145                            device_info);
 146         }
 147
 148         return 0;
 149 }
 150
 151 int write_packet(vpn_packet_t *packet)
 152 {
 153         cp();
 154
 155         if(debug_lvl >= DEBUG_TRAFFIC)
 156                 syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"),
 157                            packet->len, device_info);
 158
 159         if(write(device_fd, packet->data, packet->len) < 0) {
 160                 syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device,
 161                            strerror(errno));
 162                 return -1;
 163         }
 164
 165         device_total_out += packet->len;
 166
 167         return 0;
 168 }
 169
 170 void dump_device_stats(void)
 171 {
 172         cp();
 173
 174         syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device);
 175         syslog(LOG_DEBUG, _(" total bytes in:  %10d"), device_total_in);
 176         syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out);
 177 }