579cece0d601100e6d79fcfc080a1e2bfed5c23e
[tinc] / src / solaris / device.c
1 /*
2     device.c -- Interaction with Solaris tun device
3     Copyright (C) 2001-2005 Ivo Timmermans,
4                   2001-2011 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         ppa = 0;
59
60         ptr = device;
61         while(*ptr && !isdigit((int) *ptr))
62                 ptr++;
63         ppa = atoi(ptr);
64
65         if((ip_fd = open("/dev/ip", O_RDWR, 0)) < 0) {
66                 logger(LOG_ERR, "Could not open /dev/ip: %s", strerror(errno));
67                 return false;
68         }
69
70         /* Assign a new PPA and get its unit number. */
71         if((ppa = ioctl(device_fd, TUNNEWPPA, ppa)) < 0) {
72                 logger(LOG_ERR, "Can't assign new interface: %s", strerror(errno));
73                 return false;
74         }
75
76         if((if_fd = open(device, O_RDWR, 0)) < 0) {
77                 logger(LOG_ERR, "Could not open %s twice: %s", device,
78                            strerror(errno));
79                 return false;
80         }
81
82         if(ioctl(if_fd, I_PUSH, "ip") < 0) {
83                 logger(LOG_ERR, "Can't push IP module: %s", strerror(errno));
84                 return false;
85         }
86
87         /* Assign ppa according to the unit number returned by tun device */
88         if(ioctl(if_fd, IF_UNITSEL, (char *) &ppa) < 0) {
89                 logger(LOG_ERR, "Can't set PPA %d: %s", ppa, strerror(errno));
90                 return false;
91         }
92
93         if(ioctl(ip_fd, I_LINK, if_fd) < 0) {
94                 logger(LOG_ERR, "Can't link TUN device to IP: %s", strerror(errno));
95                 return false;
96         }
97
98         if(!get_config_string(lookup_config(config_tree, "Interface"), &iface))
99                 xasprintf(&iface, "tun%d", ppa);
100
101         device_info = "Solaris tun device";
102
103         logger(LOG_INFO, "%s is a %s", device, device_info);
104
105         return true;
106 }
107
108 static void close_device(void) {
109         close(if_fd);
110         close(ip_fd);
111         close(device_fd);
112
113         free(device);
114         free(iface);
115 }
116
117 static bool read_packet(vpn_packet_t *packet) {
118         int lenin;
119
120         if((lenin = read(device_fd, packet->data + 14, MTU - 14)) <= 0) {
121                 logger(LOG_ERR, "Error while reading from %s %s: %s", device_info,
122                            device, strerror(errno));
123                 return false;
124         }
125
126         switch(packet->data[14] >> 4) {
127                 case 4:
128                         packet->data[12] = 0x08;
129                         packet->data[13] = 0x00;
130                         break;
131                 case 6:
132                         packet->data[12] = 0x86;
133                         packet->data[13] = 0xDD;
134                         break;
135                 default:
136                         ifdebug(TRAFFIC) logger(LOG_ERR,
137                                            "Unknown IP version %d while reading packet from %s %s",
138                                            packet->data[14] >> 4, device_info, device);
139                         return false;
140         }
141
142         packet->len = lenin + 14;
143
144         device_total_in += packet->len;
145
146         ifdebug(TRAFFIC) logger(LOG_DEBUG, "Read packet of %d bytes from %s", packet->len,
147                            device_info);
148
149         return true;
150 }
151
152 static bool write_packet(vpn_packet_t *packet) {
153         ifdebug(TRAFFIC) logger(LOG_DEBUG, "Writing packet of %d bytes to %s",
154                            packet->len, device_info);
155
156         if(write(device_fd, packet->data + 14, packet->len - 14) < 0) {
157                 logger(LOG_ERR, "Can't write to %s %s: %s", device_info,
158                            device, strerror(errno));
159                 return false;
160         }
161
162         device_total_out += packet->len;
163
164         return true;
165 }
166
167 static void dump_device_stats(void) {
168         logger(LOG_DEBUG, "Statistics for %s %s:", device_info, device);
169         logger(LOG_DEBUG, " total bytes in:  %10"PRIu64, device_total_in);
170         logger(LOG_DEBUG, " total bytes out: %10"PRIu64, device_total_out);
171 }
172
173 const devops_t os_devops = {
174         .setup = setup_device,
175         .close = close_device,
176         .read = read_packet,
177         .write = write_packet,
178         .dump_stats = dump_device_stats,
179 };