254452010e4a0fd59334312471e845025f79a55d
[tinc] / src / raw_socket / device.c
1 /*
2     device.c -- raw socket
3     Copyright (C) 2002-2003 Ivo Timmermans <ivo@o2w.nl>,
4                   2002-2003 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.2 2003/08/24 20:38:31 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 <string.h>
33 #include <sys/ioctl.h>
34 #include <sys/socket.h>
35 #include <netpacket/packet.h>
36 #include <net/ethernet.h>
37
38 #include <utils.h>
39 #include "conf.h"
40 #include "net.h"
41 #include "logger.h"
42
43 #include "system.h"
44
45 int device_fd = -1;
46 char *device;
47 char *interface;
48 char ifrname[IFNAMSIZ];
49 char *device_info;
50
51 int device_total_in = 0;
52 int device_total_out = 0;
53
54 bool setup_device(void)
55 {
56         struct ifreq ifr;
57         struct sockaddr_ll sa;
58
59         cp();
60
61         if(!get_config_string
62                   (lookup_config(config_tree, "Interface"), &interface))
63                 interface = "eth0";
64
65         if(!get_config_string(lookup_config(config_tree, "Device"), &device))
66                 device = interface;
67
68         device_info = _("raw socket");
69
70         if((device_fd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL))) < 0) {
71                 logger(LOG_ERR, _("Could not open %s: %s"), device_info,
72                            strerror(errno));
73                 return false;
74         }
75
76         memset(&ifr, 0, sizeof(ifr));
77         strncpy(ifr.ifr_ifrn.ifrn_name, interface, IFNAMSIZ);
78         if(ioctl(device_fd, SIOCGIFINDEX, &ifr)) {
79                 close(device_fd);
80                 logger(LOG_ERR, _("Can't find interface %s: %s"), interface,
81                            strerror(errno));
82                 return false;
83         }
84
85         memset(&sa, '0', sizeof(sa));
86         sa.sll_family = AF_PACKET;
87         sa.sll_protocol = htons(ETH_P_ALL);
88         sa.sll_ifindex = ifr.ifr_ifindex;
89
90         if(bind(device_fd, (struct sockaddr *) &sa, (socklen_t) sizeof(sa))) {
91                 logger(LOG_ERR, _("Could not bind to %s: %s"), device, strerror(errno));
92                 return false;
93         }
94
95         logger(LOG_INFO, _("%s is a %s"), device, device_info);
96
97         return true;
98 }
99
100 void close_device(void)
101 {
102         cp();
103
104         close(device_fd);
105 }
106
107 bool read_packet(vpn_packet_t *packet)
108 {
109         int lenin;
110
111         cp();
112
113         if((lenin = read(device_fd, packet->data, MTU)) <= 0) {
114                 logger(LOG_ERR, _("Error while reading from %s %s: %s"), device_info,
115                            device, strerror(errno));
116                 return false;
117         }
118
119         packet->len = lenin;
120
121         device_total_in += packet->len;
122
123         ifdebug(TRAFFIC) logger(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len,
124                            device_info);
125
126         return true;
127 }
128
129 bool write_packet(vpn_packet_t *packet)
130 {
131         cp();
132
133         ifdebug(TRAFFIC) logger(LOG_DEBUG, _("Writing packet of %d bytes to %s"),
134                            packet->len, device_info);
135
136         if(write(device_fd, packet->data, packet->len) < 0) {
137                 logger(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device,
138                            strerror(errno));
139                 return false;
140         }
141
142         device_total_out += packet->len;
143
144         return true;
145 }
146
147 void dump_device_stats(void)
148 {
149         cp();
150
151         logger(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device);
152         logger(LOG_DEBUG, _(" total bytes in:  %10d"), device_total_in);
153         logger(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out);
154 }