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