26121e27350b9e5974f6b8982f58a3753eca8be9
[tinc] / src / solaris / device.c
1 /*
2     device.c -- Interaction with Solaris tun device
3     Copyright (C) 2001-2005 Ivo Timmermans,
4                   2001-2012 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
22 #include "system.h"
23
24 #include <sys/stropts.h>
25 #include <sys/sockio.h>
26 #include <net/if_tun.h>
27
28 #include "conf.h"
29 #include "device.h"
30 #include "logger.h"
31 #include "net.h"
32 #include "utils.h"
33 #include "xalloc.h"
34
35 #define DEFAULT_DEVICE "/dev/tun"
36
37 int device_fd = -1;
38 static int ip_fd = -1, if_fd = -1;
39 char *device = NULL;
40 char *iface = NULL;
41 static char *device_info = NULL;
42
43 static uint64_t device_total_in = 0;
44 static uint64_t device_total_out = 0;
45
46 static bool setup_device(void) {
47         int ppa;
48         char *ptr;
49
50         if(!get_config_string(lookup_config(config_tree, "Device"), &device))
51                 device = xstrdup(DEFAULT_DEVICE);
52
53         if((device_fd = open(device, O_RDWR | O_NONBLOCK)) < 0) {
54                 logger(LOG_ERR, "Could not open %s: %s", device, strerror(errno));
55                 return false;
56         }
57
58 #ifdef FD_CLOEXEC
59         fcntl(device_fd, F_SETFD, FD_CLOEXEC);
60 #endif
61
62         ppa = 0;
63
64         ptr = device;
65         while(*ptr && !isdigit((int) *ptr))
66                 ptr++;
67         ppa = atoi(ptr);
68
69         if((ip_fd = open("/dev/ip", O_RDWR, 0)) < 0) {
70                 logger(LOG_ERR, "Could not open /dev/ip: %s", strerror(errno));
71                 return false;
72         }
73
74 #ifdef FD_CLOEXEC
75         fcntl(ip_fd, F_SETFD, FD_CLOEXEC);
76 #endif
77
78         /* Assign a new PPA and get its unit number. */
79         if((ppa = ioctl(device_fd, TUNNEWPPA, ppa)) < 0) {
80                 logger(LOG_ERR, "Can't assign new interface: %s", strerror(errno));
81                 return false;
82         }
83
84         if((if_fd = open(device, O_RDWR, 0)) < 0) {
85                 logger(LOG_ERR, "Could not open %s twice: %s", device,
86                            strerror(errno));
87                 return false;
88         }
89
90 #ifdef FD_CLOEXEC
91         fcntl(if_fd, F_SETFD, FD_CLOEXEC);
92 #endif
93
94         if(ioctl(if_fd, I_PUSH, "ip") < 0) {
95                 logger(LOG_ERR, "Can't push IP module: %s", strerror(errno));
96                 return false;
97         }
98
99         /* Assign ppa according to the unit number returned by tun device */
100         if(ioctl(if_fd, IF_UNITSEL, (char *) &ppa) < 0) {
101                 logger(LOG_ERR, "Can't set PPA %d: %s", ppa, strerror(errno));
102                 return false;
103         }
104
105         if(ioctl(ip_fd, I_LINK, if_fd) < 0) {
106                 logger(LOG_ERR, "Can't link TUN device to IP: %s", strerror(errno));
107                 return false;
108         }
109
110         if(!get_config_string(lookup_config(config_tree, "Interface"), &iface))
111                 xasprintf(&iface, "tun%d", ppa);
112
113         device_info = "Solaris tun device";
114
115         logger(LOG_INFO, "%s is a %s", device, device_info);
116
117         return true;
118 }
119
120 static void close_device(void) {
121         close(if_fd);
122         close(ip_fd);
123         close(device_fd);
124
125         free(device);
126         free(iface);
127 }
128
129 static bool read_packet(vpn_packet_t *packet) {
130         int lenin;
131
132         if((lenin = read(device_fd, packet->data + 14, MTU - 14)) <= 0) {
133                 logger(LOG_ERR, "Error while reading from %s %s: %s", device_info,
134                            device, strerror(errno));
135                 return false;
136         }
137
138         switch(packet->data[14] >> 4) {
139                 case 4:
140                         packet->data[12] = 0x08;
141                         packet->data[13] = 0x00;
142                         break;
143                 case 6:
144                         packet->data[12] = 0x86;
145                         packet->data[13] = 0xDD;
146                         break;
147                 default:
148                         ifdebug(TRAFFIC) logger(LOG_ERR,
149                                            "Unknown IP version %d while reading packet from %s %s",
150                                            packet->data[14] >> 4, device_info, device);
151                         return false;
152         }
153
154         memset(packet->data, 0, 12);
155         packet->len = lenin + 14;
156
157         device_total_in += packet->len;
158
159         ifdebug(TRAFFIC) logger(LOG_DEBUG, "Read packet of %d bytes from %s", packet->len,
160                            device_info);
161
162         return true;
163 }
164
165 static bool write_packet(vpn_packet_t *packet) {
166         ifdebug(TRAFFIC) logger(LOG_DEBUG, "Writing packet of %d bytes to %s",
167                            packet->len, device_info);
168
169         if(write(device_fd, packet->data + 14, packet->len - 14) < 0) {
170                 logger(LOG_ERR, "Can't write to %s %s: %s", device_info,
171                            device, strerror(errno));
172                 return false;
173         }
174
175         device_total_out += packet->len;
176
177         return true;
178 }
179
180 static void dump_device_stats(void) {
181         logger(LOG_DEBUG, "Statistics for %s %s:", device_info, device);
182         logger(LOG_DEBUG, " total bytes in:  %10"PRIu64, device_total_in);
183         logger(LOG_DEBUG, " total bytes out: %10"PRIu64, device_total_out);
184 }
185
186 const devops_t os_devops = {
187         .setup = setup_device,
188         .close = close_device,
189         .read = read_packet,
190         .write = write_packet,
191         .dump_stats = dump_device_stats,
192 };