K&R style braces.
[tinc] / src / raw_socket / device.c
1 /*
2     device.c -- raw socket
3     Copyright (C) 2002-2005 Ivo Timmermans,
4                   2002-2009 Guus Sliepen <guus@tinc-vpn.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 along
17     with this program; if not, write to the Free Software Foundation, Inc.,
18     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 */
20
21 #include "system.h"
22
23 #include <netpacket/packet.h>
24
25 #include "conf.h"
26 #include "net.h"
27 #include "logger.h"
28 #include "utils.h"
29 #include "route.h"
30 #include "xalloc.h"
31
32 int device_fd = -1;
33 char *device = NULL;
34 char *iface = NULL;
35 static char ifrname[IFNAMSIZ];
36 static char *device_info;
37
38 static int device_total_in = 0;
39 static int device_total_out = 0;
40
41 bool setup_device(void) {
42         struct ifreq ifr;
43         struct sockaddr_ll sa;
44
45         cp();
46
47         if(!get_config_string(lookup_config(config_tree, "Interface"), &iface))
48                 iface = xstrdup("eth0");
49
50         if(!get_config_string(lookup_config(config_tree, "Device"), &device))
51                 device = xstrdup(iface);
52
53         device_info = _("raw socket");
54
55         if((device_fd = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL))) < 0) {
56                 logger(LOG_ERR, _("Could not open %s: %s"), device_info,
57                            strerror(errno));
58                 return false;
59         }
60
61         memset(&ifr, 0, sizeof(ifr));
62         strncpy(ifr.ifr_ifrn.ifrn_name, iface, IFNAMSIZ);
63         if(ioctl(device_fd, SIOCGIFINDEX, &ifr)) {
64                 close(device_fd);
65                 logger(LOG_ERR, _("Can't find interface %s: %s"), iface,
66                            strerror(errno));
67                 return false;
68         }
69
70         memset(&sa, '0', sizeof(sa));
71         sa.sll_family = AF_PACKET;
72         sa.sll_protocol = htons(ETH_P_ALL);
73         sa.sll_ifindex = ifr.ifr_ifindex;
74
75         if(bind(device_fd, (struct sockaddr *) &sa, (socklen_t) sizeof(sa))) {
76                 logger(LOG_ERR, _("Could not bind %s to %s: %s"), device, iface, strerror(errno));
77                 return false;
78         }
79
80         logger(LOG_INFO, _("%s is a %s"), device, device_info);
81
82         return true;
83 }
84
85 void close_device(void) {
86         cp();
87
88         close(device_fd);
89
90         free(device);
91         free(iface);
92 }
93
94 bool read_packet(vpn_packet_t *packet) {
95         int lenin;
96
97         cp();
98
99         if((lenin = read(device_fd, packet->data, MTU)) <= 0) {
100                 logger(LOG_ERR, _("Error while reading from %s %s: %s"), device_info,
101                            device, strerror(errno));
102                 return false;
103         }
104
105         packet->len = lenin;
106
107         device_total_in += packet->len;
108
109         ifdebug(TRAFFIC) logger(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len,
110                            device_info);
111
112         return true;
113 }
114
115 bool write_packet(vpn_packet_t *packet) {
116         cp();
117
118         ifdebug(TRAFFIC) logger(LOG_DEBUG, _("Writing packet of %d bytes to %s"),
119                            packet->len, device_info);
120
121         if(write(device_fd, packet->data, packet->len) < 0) {
122                 logger(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device,
123                            strerror(errno));
124                 return false;
125         }
126
127         device_total_out += packet->len;
128
129         return true;
130 }
131
132 void dump_device_stats(void) {
133         cp();
134
135         logger(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device);
136         logger(LOG_DEBUG, _(" total bytes in:  %10d"), device_total_in);
137         logger(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out);
138 }