f47cc4488f5e6e8494550fd01b2811eeac329738
[tinc] / src / openbsd / device.c
1 /*
2     device.c -- Interaction with OpenBSD tun device
3     Copyright (C) 2001-2002 Ivo Timmermans <itimmermans@bigfoot.com>,
4                   2001-2002 Guus Sliepen <guus@sliepen.warande.net>
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.3 2002/04/13 11:08:31 zarq Exp $
21 */
22
23 #include "config.h"
24
25 #include <stdio.h>
26 #include <errno.h>
27 #include <sys/types.h>
28 #include <sys/uio.h>
29 #include <sys/stat.h>
30 #include <sys/ioctl.h>
31 #include <sys/socket.h>
32 #include <fcntl.h>
33 #include <net/if.h>
34 #include <unistd.h>
35 #include <string.h>
36
37 #include <utils.h>
38 #include "conf.h"
39 #include "net.h"
40 #include "subnet.h"
41 #include "logging.h"
42
43 #include "system.h"
44
45 #define DEFAULT_DEVICE "/dev/tun0"
46
47 #define DEVICE_TYPE_ETHERTAP 0
48 #define DEVICE_TYPE_TUNTAP 1
49
50 int device_fd = -1;
51 int device_type;
52 char *device;
53 char *interface;
54 char *device_info;
55
56 int device_total_in = 0;
57 int device_total_out = 0;
58
59 extern subnet_t mymac;
60
61 /*
62   open the local ethertap device
63 */
64 int setup_device(void)
65 {
66   if(!get_config_string(lookup_config(config_tree, "Device"), &device))
67     device = DEFAULT_DEVICE;
68
69   if(!get_config_string(lookup_config(config_tree, "Interface"), &interface))
70     interface = rindex(device, '/')?rindex(device, '/')+1:device;
71 cp
72   if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0)
73     {
74       syslog(LOG_ERR, _("Could not open %s: %s"), device, strerror(errno));
75       return -1;
76     }
77 cp
78   /* Set default MAC address for ethertap devices */
79
80   mymac.type = SUBNET_MAC;
81   mymac.net.mac.address.x[0] = 0xfe;
82   mymac.net.mac.address.x[1] = 0xfd;
83   mymac.net.mac.address.x[2] = 0x00;
84   mymac.net.mac.address.x[3] = 0x00;
85   mymac.net.mac.address.x[4] = 0x00;
86   mymac.net.mac.address.x[5] = 0x00;
87
88   device_info = _("OpenBSD tun device");
89
90   syslog(LOG_INFO, _("%s is a %s"), device, device_info);
91 cp
92   return 0;
93 }
94
95 void close_device(void)
96 {
97 cp
98   close(device_fd);
99 cp
100 }
101
102 int read_packet(vpn_packet_t *packet)
103 {
104   int lenin;
105   u_int32_t type;
106   struct iovec vector[2] = {{&type, sizeof(type)}, {packet->data + 14, MTU - 14}};
107 cp
108
109   if((lenin = readv(device_fd, vector, 2)) <= 0)
110     {
111       syslog(LOG_ERR, _("Error while reading from %s %s: %s"), device_info, device, strerror(errno));
112       return -1;
113     }
114
115   memcpy(packet->data, mymac.net.mac.address.x, 6);
116   memcpy(packet->data + 6, mymac.net.mac.address.x, 6);
117
118   switch(ntohl(type))
119     {
120       case AF_INET:
121         packet->data[12] = 0x8;
122         packet->data[13] = 0x0;
123         break;
124       case AF_INET6:
125         packet->data[12] = 0x86;
126         packet->data[13] = 0xDD;
127         break;
128       default:
129         if(debug_lvl >= DEBUG_TRAFFIC)
130           syslog(LOG_ERR, _("Unknown address family %d while reading packet from %s %s"), ntohl(type), device_info, device);
131         return -1;
132     }
133
134   packet->len = lenin + 10;
135
136   device_total_in += packet->len;
137
138   if(debug_lvl >= DEBUG_TRAFFIC)
139     {
140       syslog(LOG_DEBUG, _("Read packet of %d bytes from %s"), packet->len, device_info);
141     }
142
143   return 0;
144 cp
145 }
146
147 int write_packet(vpn_packet_t *packet)
148 {
149   u_int32_t type;
150   struct iovec vector[2];
151   int af;
152 cp
153   if(debug_lvl >= DEBUG_TRAFFIC)
154     syslog(LOG_DEBUG, _("Writing packet of %d bytes to %s"),
155            packet->len, device_info);
156
157   af = (packet->data[12] << 8) + packet->data[13];
158
159   switch(af)
160     {
161       case 0x800:
162         type = htonl(AF_INET);
163         break;
164       case 0x86DD:
165         type = htonl(AF_INET6);
166         break;
167       default:
168         if(debug_lvl >= DEBUG_TRAFFIC)
169           syslog(LOG_ERR, _("Unknown address family %d while writing packet to %s %s"), af, device_info, device);
170         return -1;
171     }
172
173   vector[0].iov_base = &type;
174   vector[0].iov_len = sizeof(type);
175   vector[1].iov_base = packet->data + 14;
176   vector[1].iov_len = packet->len - 14;
177
178   if(writev(device_fd, vector, 2) < 0)
179     {
180       syslog(LOG_ERR, _("Can't write to %s %s: %s"), device_info, device, strerror(errno));
181       return -1;
182     }
183
184   device_total_out += packet->len;
185 cp
186 }
187
188 void dump_device_stats(void)
189 {
190 cp
191   syslog(LOG_DEBUG, _("Statistics for %s %s:"), device_info, device);
192   syslog(LOG_DEBUG, _(" total bytes in:  %10d"), device_total_in);
193   syslog(LOG_DEBUG, _(" total bytes out: %10d"), device_total_out);
194 cp
195 }