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