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