minor
[tinc] / src / fd_device.c
1 /*
2     fd_device.c -- Interaction with Android tun fd
3     Copyright (C)   2001-2005   Ivo Timmermans,
4                     2001-2016   Guus Sliepen <guus@tinc-vpn.org>
5                     2009        Grzegorz Dymarek <gregd72002@googlemail.com>
6                     2016        Pacien TRAN-GIRARD <pacien@pacien.net>
7
8     This program is free software; you can redistribute it and/or modify
9     it under the terms of the GNU General Public License as published by
10     the Free Software Foundation; either version 2 of the License, or
11     (at your option) any later version.
12
13     This program is distributed in the hope that it will be useful,
14     but WITHOUT ANY WARRANTY; without even the implied warranty of
15     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16     GNU General Public License for more details.
17
18     You should have received a copy of the GNU General Public License along
19     with this program; if not, write to the Free Software Foundation, Inc.,
20     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
21 */
22
23 #include "system.h"
24 #include "conf.h"
25 #include "device.h"
26 #include "ethernet.h"
27 #include "logger.h"
28 #include "net.h"
29 #include "route.h"
30 #include "utils.h"
31
32 static inline bool check_config(void) {
33         if(routing_mode == RMODE_SWITCH) {
34                 logger(DEBUG_ALWAYS, LOG_ERR, "Switch mode not supported (requires unsupported TAP device)!");
35                 return false;
36         }
37
38         if(!get_config_int(lookup_config(config_tree, "Device"), &device_fd)) {
39                 logger(DEBUG_ALWAYS, LOG_ERR, "Could not read fd from configuration!");
40                 return false;
41         }
42
43         return true;
44 }
45
46 static bool setup_device(void) {
47         if(!check_config()) {
48                 return false;
49         }
50
51         if(device_fd < 0) {
52                 logger(DEBUG_ALWAYS, LOG_ERR, "Could not open %s: %s!", device, strerror(errno));
53                 return false;
54         }
55
56         logger(DEBUG_ALWAYS, LOG_INFO, "fd/%d adapter set up.", device_fd);
57
58         return true;
59 }
60
61 static void close_device(void) {
62         close(device_fd);
63         device_fd = -1;
64 }
65
66 static inline uint16_t get_ip_ethertype(vpn_packet_t *packet) {
67         switch(DATA(packet)[ETH_HLEN] >> 4) {
68         case 4:
69                 return ETH_P_IP;
70
71         case 6:
72                 return ETH_P_IPV6;
73
74         default:
75                 return ETH_P_MAX;
76         }
77 }
78
79 static inline void set_etherheader(vpn_packet_t *packet, uint16_t ethertype) {
80         memset(DATA(packet), 0, ETH_HLEN - ETHER_TYPE_LEN);
81
82         DATA(packet)[ETH_HLEN - ETHER_TYPE_LEN] = (ethertype >> 8) & 0xFF;
83         DATA(packet)[ETH_HLEN - ETHER_TYPE_LEN + 1] = ethertype & 0xFF;
84 }
85
86 static bool read_packet(vpn_packet_t *packet) {
87         int lenin = read(device_fd, DATA(packet) + ETH_HLEN, MTU - ETH_HLEN);
88
89         if(lenin <= 0) {
90                 logger(DEBUG_ALWAYS, LOG_ERR, "Error while reading from fd/%d: %s!", device_fd, strerror(errno));
91                 return false;
92         }
93
94         uint16_t ethertype = get_ip_ethertype(packet);
95
96         if(ethertype == ETH_P_MAX) {
97                 logger(DEBUG_TRAFFIC, LOG_ERR, "Unknown IP version while reading packet from fd/%d!", device_fd);
98                 return false;
99         }
100
101         set_etherheader(packet, ethertype);
102         packet->len = lenin + ETH_HLEN;
103
104         logger(DEBUG_TRAFFIC, LOG_DEBUG, "Read packet of %d bytes from fd/%d.", packet->len, device_fd);
105
106         return true;
107 }
108
109 static bool write_packet(vpn_packet_t *packet) {
110         logger(DEBUG_TRAFFIC, LOG_DEBUG, "Writing packet of %d bytes to fd/%d.", packet->len, device_fd);
111
112         if(write(device_fd, DATA(packet) + ETH_HLEN, packet->len - ETH_HLEN) < 0) {
113                 logger(DEBUG_ALWAYS, LOG_ERR, "Error while writing to fd/%d: %s!", device_fd, strerror(errno));
114                 return false;
115         }
116
117         return true;
118 }
119
120 const devops_t fd_devops = {
121         .setup = setup_device,
122         .close = close_device,
123         .read = read_packet,
124         .write = write_packet,
125 };