1 | /* |
1 | /* |
2 | device-cygwin.C -- Stub for Cygwin environment |
2 | device-cygwin.C -- Stub for Cygwin environment |
3 | Copyright (C) 2003 Marc Lehmann <ocg@goof.com> |
3 | Copyright (C) 2003-2004 Marc Lehmann <ocg@goof.com> |
4 | Copyright (C) 2002-2003 Ivo Timmermans <ivo@o2w.nl>, |
4 | Copyright (C) 2002-2003 Ivo Timmermans <ivo@o2w.nl>, |
5 | 2002-2003 Guus Sliepen <guus@sliepen.eu.org> |
5 | 2002-2003 Guus Sliepen <guus@sliepen.eu.org> |
6 | |
6 | |
7 | This program is free software; you can redistribute it and/or modify |
7 | This program is free software; you can redistribute it and/or modify |
8 | it under the terms of the GNU General Public License as published by |
8 | it under the terms of the GNU General Public License as published by |
… | |
… | |
34 | #include <errno.h> |
34 | #include <errno.h> |
35 | #include <sys/types.h> |
35 | #include <sys/types.h> |
36 | #include <sys/stat.h> |
36 | #include <sys/stat.h> |
37 | #include <fcntl.h> |
37 | #include <fcntl.h> |
38 | #include <unistd.h> |
38 | #include <unistd.h> |
39 | #include <syslog.h> |
|
|
40 | #include <cstring> |
39 | #include <cstring> |
41 | |
40 | |
42 | #include "conf.h" |
41 | #include "conf.h" |
43 | #include "util.h" |
42 | #include "util.h" |
44 | |
43 | |
|
|
44 | #include <io.h> |
45 | #include <w32api/windows.h> |
45 | #include <w32api/windows.h> |
46 | #include <w32api/winioctl.h> |
46 | #include <w32api/winioctl.h> |
47 | |
47 | |
48 | #define REG_CONTROL_NET "SYSTEM\\CurrentControlSet\\Control\\Network\\{4D36E972-E325-11CE-BFC1-08002BE10318}" |
48 | #define REG_CONTROL_NET "SYSTEM\\CurrentControlSet\\Control\\Network\\{4D36E972-E325-11CE-BFC1-08002BE10318}" |
49 | |
49 | |
… | |
… | |
51 | #define USERDEVICEDIR "\\??\\" |
51 | #define USERDEVICEDIR "\\??\\" |
52 | #define TAPSUFFIX ".tap" |
52 | #define TAPSUFFIX ".tap" |
53 | |
53 | |
54 | #define TAP_CONTROL_CODE(request,method) CTL_CODE(FILE_DEVICE_PHYSICAL_NETCARD | 8000, request, method, FILE_ANY_ACCESS) |
54 | #define TAP_CONTROL_CODE(request,method) CTL_CODE(FILE_DEVICE_PHYSICAL_NETCARD | 8000, request, method, FILE_ANY_ACCESS) |
55 | |
55 | |
56 | #define TAP_IOCTL_GET_LASTMAC TAP_CONTROL_CODE(0, METHOD_BUFFERED) |
56 | #define TAP_IOCTL_GET_LASTMAC TAP_CONTROL_CODE(0, METHOD_BUFFERED) |
57 | #define TAP_IOCTL_GET_MAC TAP_CONTROL_CODE(1, METHOD_BUFFERED) |
57 | #define TAP_IOCTL_GET_MAC TAP_CONTROL_CODE(1, METHOD_BUFFERED) |
58 | #define TAP_IOCTL_SET_STATISTICS TAP_CONTROL_CODE(2, METHOD_BUFFERED) |
58 | #define TAP_IOCTL_SET_STATISTICS TAP_CONTROL_CODE(2, METHOD_BUFFERED) |
59 | |
59 | #define TAP_IOCTL_SET_MEDIA_STATUS TAP_CONTROL_CODE(7, METHOD_BUFFERED) |
60 | static HANDLE device_handle = INVALID_HANDLE_VALUE; |
|
|
61 | static mac my_mac; |
|
|
62 | |
60 | |
63 | static const char * |
61 | static const char * |
64 | wstrerror (int err) |
62 | wstrerror (int err) |
65 | { |
63 | { |
66 | static char buf[1024]; |
64 | static char buf[1024]; |
… | |
… | |
70 | MAKELANGID (LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof (buf), NULL)) |
68 | MAKELANGID (LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof (buf), NULL)) |
71 | { |
69 | { |
72 | strncpy (buf, _("(unable to format errormessage)"), sizeof (buf)); |
70 | strncpy (buf, _("(unable to format errormessage)"), sizeof (buf)); |
73 | }; |
71 | }; |
74 | |
72 | |
|
|
73 | char *nl; |
75 | if ((char *newline = strchr (buf, '\r'))) |
74 | if ((nl = strchr (buf, '\r'))) |
76 | *newline = '\0'; |
75 | *nl = '\0'; |
77 | |
76 | |
78 | return buf; |
77 | return buf; |
|
|
78 | } |
|
|
79 | |
|
|
80 | static HANDLE device_handle = INVALID_HANDLE_VALUE; |
|
|
81 | static mac local_mac; |
|
|
82 | static tap_packet *rcv_pkt; |
|
|
83 | static int iopipe[2]; |
|
|
84 | static HANDLE pipe_handle, send_event, thread; |
|
|
85 | |
|
|
86 | static DWORD WINAPI |
|
|
87 | read_thread(void *) |
|
|
88 | { |
|
|
89 | static OVERLAPPED overlapped; |
|
|
90 | static DWORD dlen; |
|
|
91 | static u32 len; |
|
|
92 | static u8 data[MAX_MTU]; |
|
|
93 | |
|
|
94 | overlapped.hEvent = CreateEvent (NULL, FALSE, FALSE, NULL); |
|
|
95 | |
|
|
96 | for (;;) |
|
|
97 | { |
|
|
98 | if (!ReadFile (device_handle, data, MAX_MTU, &dlen, &overlapped)) |
|
|
99 | { |
|
|
100 | if (GetLastError () == ERROR_IO_PENDING) |
|
|
101 | GetOverlappedResult (device_handle, &overlapped, &dlen, TRUE); |
|
|
102 | else |
|
|
103 | { |
|
|
104 | slog (L_ERR, "WIN32 TAP: ReadFile returned error: %s", wstrerror (GetLastError ())); |
|
|
105 | exit (1); |
|
|
106 | } |
|
|
107 | } |
|
|
108 | |
|
|
109 | if (dlen > 0) |
|
|
110 | { |
|
|
111 | len = dlen; |
|
|
112 | WriteFile (pipe_handle, &len, sizeof (len), &dlen, NULL); |
|
|
113 | WriteFile (pipe_handle, data, len, &dlen, NULL); |
|
|
114 | } |
|
|
115 | } |
79 | } |
116 | } |
80 | |
117 | |
81 | const char * |
118 | const char * |
82 | tap_device::info () |
119 | tap_device::info () |
83 | { |
120 | { |
… | |
… | |
89 | HKEY key, key2; |
126 | HKEY key, key2; |
90 | int i; |
127 | int i; |
91 | |
128 | |
92 | char regpath[1024]; |
129 | char regpath[1024]; |
93 | char adapterid[1024]; |
130 | char adapterid[1024]; |
94 | char adaptername[1024]; |
131 | BYTE adaptername[1024]; |
95 | char tapname[1024]; |
132 | char tapname[1024]; |
96 | long len; |
133 | DWORD len; |
97 | |
134 | |
98 | bool found = false; |
135 | bool found = false; |
99 | |
136 | |
100 | int sock, err; |
137 | int sock, err; |
101 | |
138 | |
102 | /* Open registry and look for network adapters */ |
139 | /* Open registry and look for network adapters */ |
103 | |
140 | |
104 | if (RegOpenKeyEx (HKEY_LOCAL_MACHINE, REG_CONTROL_NET, 0, KEY_READ, &key)) |
141 | if (RegOpenKeyEx (HKEY_LOCAL_MACHINE, REG_CONTROL_NET, 0, KEY_READ, &key)) |
105 | { |
142 | { |
106 | slog (L_ERR, _("Unable to read registry: %s"), |
143 | slog (L_ERR, _("WIN32 TAP: unable to read registry: %s"), |
107 | wstrerror (GetLastError ())); |
144 | wstrerror (GetLastError ())); |
108 | return false; |
145 | exit (1); |
109 | } |
146 | } |
110 | |
147 | |
111 | for (i = 0;; i++) |
148 | for (i = 0;; i++) |
112 | { |
149 | { |
113 | len = sizeof (adapterid); |
150 | len = sizeof (adapterid); |
… | |
… | |
153 | |
190 | |
154 | RegCloseKey (key); |
191 | RegCloseKey (key); |
155 | |
192 | |
156 | if (!found) |
193 | if (!found) |
157 | { |
194 | { |
158 | slog (L_ERR, _("No Windows tap device found!")); |
195 | slog (L_ERR, _("WIN32 TAP: no windows tap device found!")); |
159 | exit (1); |
196 | exit (1); |
160 | } |
197 | } |
161 | |
198 | |
162 | strcpy (ifrname, adaptername); |
|
|
163 | |
|
|
164 | /* Try to open the corresponding tap device */ |
199 | /* Try to open the corresponding tap device */ |
165 | |
200 | |
166 | if (device_handle == INVALID_HANDLE_VALUE) |
201 | if (device_handle == INVALID_HANDLE_VALUE) |
167 | { |
202 | { |
168 | snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, device); |
203 | snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, adapterid); |
169 | device_handle = |
204 | device_handle = |
170 | CreateFile (tapname, GENERIC_WRITE | GENERIC_READ, 0, 0, |
205 | CreateFile (tapname, GENERIC_WRITE | GENERIC_READ, 0, 0, |
171 | OPEN_EXISTING, |
206 | OPEN_EXISTING, |
172 | FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0); |
207 | FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0); |
173 | } |
208 | } |
174 | |
209 | |
175 | if (device_handle == INVALID_HANDLE_VALUE) |
210 | if (device_handle == INVALID_HANDLE_VALUE) |
176 | { |
211 | { |
177 | slog (L_ERR, _("%s is not a usable Windows tap device: %s"), |
212 | slog (L_ERR, _("WIN32 TAP: %s is not a usable windows tap device %s: %s"), |
|
|
213 | adaptername, tapname, wstrerror (GetLastError ())); |
|
|
214 | exit (1); |
|
|
215 | } |
|
|
216 | |
|
|
217 | strcpy (ifrname, (char *)tapname); |
|
|
218 | |
|
|
219 | /* Get MAC address from tap device */ |
|
|
220 | |
|
|
221 | if (!DeviceIoControl (device_handle, TAP_IOCTL_GET_MAC, |
|
|
222 | &local_mac, sizeof (local_mac), &local_mac, sizeof (local_mac), |
|
|
223 | &len, 0)) |
|
|
224 | { |
|
|
225 | slog (L_ERR, |
|
|
226 | _("WIN32 TAP: could not get MAC address from windows tap device %s: %s"), |
178 | adaptername, wstrerror (GetLastError ())); |
227 | adaptername, wstrerror (GetLastError ())); |
179 | exit (1); |
228 | exit (1); |
180 | } |
229 | } |
181 | |
230 | |
182 | fd = cygwin_attach_handle_to_fd (tapname, -1, device_handle, 1, GENERIC_WRITE | GENERIC_READ); |
231 | pipe (iopipe); |
|
|
232 | fd = iopipe[0]; |
|
|
233 | pipe_handle = (HANDLE) get_osfhandle (iopipe[1]); |
183 | |
234 | |
184 | /* Get MAC address from tap device */ |
235 | send_event = CreateEvent (NULL, FALSE, FALSE, NULL); |
185 | |
236 | |
186 | if (!DeviceIoControl |
237 | thread = CreateThread (NULL, 0, read_thread, NULL, 0, NULL); |
187 | (device_handle, TAP_IOCTL_GET_MAC, &mac, sizeof (mac), &mac, sizeof (mac), &len, 0)) |
238 | |
188 | { |
239 | /* try to set driver media status to 'connected' */ |
189 | slog (L_ERR, |
240 | ULONG status = TRUE; |
190 | _("Could not get MAC address from Windows tap device %s: %s"), |
241 | DeviceIoControl (device_handle, TAP_IOCTL_SET_MEDIA_STATUS, |
191 | adaptername, wstrerror (GetLastError ())); |
242 | &status, sizeof (status), |
192 | exit (1); |
243 | &status, sizeof (status), &len, NULL); |
193 | } |
244 | // ignore error here on purpose |
194 | } |
245 | } |
195 | |
246 | |
196 | tap_device::~tap_device () |
247 | tap_device::~tap_device () |
197 | { |
248 | { |
198 | close (fd); |
249 | close (iopipe[0]); |
|
|
250 | close (iopipe[1]); |
|
|
251 | CloseHandle (device_handle); |
|
|
252 | CloseHandle (send_event); |
199 | } |
253 | } |
200 | |
254 | |
201 | tap_packet * |
255 | tap_packet * |
202 | tap_device::recv () |
256 | tap_device::recv () |
203 | { |
257 | { |
204 | tap_packet *pkt = new tap_packet; |
258 | tap_packet *pkt = new tap_packet; |
205 | |
259 | |
206 | pkt->len = read (fd, &((*pkt)[0]), MAX_MTU); |
260 | if (sizeof (u32) != read (iopipe[0], &pkt->len, sizeof (u32))) |
207 | |
|
|
208 | if (pkt->len <= 0) |
|
|
209 | { |
261 | { |
210 | slog (L_ERR, _("error while reading from %s %s: %s"), |
262 | slog (L_ERR, _("WIN32 TAP: i/o thread delivered incomplete pkt length")); |
211 | info (), conf.ifname, strerror (errno)); |
263 | delete pkt; |
212 | free (pkt); |
|
|
213 | return 0; |
264 | return 0; |
214 | } |
265 | } |
215 | |
266 | |
|
|
267 | if (pkt->len != read (iopipe[0], &((*pkt)[0]), pkt->len)) |
|
|
268 | { |
|
|
269 | slog (L_ERR, _("WIN32 TAP: i/o thread delivered incomplete pkt")); |
|
|
270 | delete pkt; |
|
|
271 | return 0; |
|
|
272 | } |
|
|
273 | |
216 | id2mac (THISNODE->id, &((*pkt)[6])); |
274 | id2mac (THISNODE->id, &((*pkt)[6])); |
217 | |
275 | |
218 | if (pkt->is_arp ()) |
276 | if (pkt->is_arp ()) |
219 | { |
277 | { |
220 | if ((*pkt)[22] == 0x08) |
278 | if (!memcmp (&(*pkt)[22], &local_mac, sizeof (mac))) id2mac (THISNODE->id, &((*pkt)[22])); |
221 | id2mac (THISNODE->id, &((*pkt)[22])); |
279 | if (!memcmp (&(*pkt)[32], &local_mac, sizeof (mac))) id2mac (THISNODE->id, &((*pkt)[32])); |
222 | if ((*pkt)[32] == 0x08) |
|
|
223 | id2mac (THISNODE->id, &((*pkt)[32])); |
|
|
224 | } |
280 | } |
225 | |
281 | |
226 | return pkt; |
282 | return pkt; |
227 | } |
283 | } |
228 | |
284 | |
229 | void |
285 | void |
230 | tap_device::send (tap_packet * pkt) |
286 | tap_device::send (tap_packet * pkt) |
231 | { |
287 | { |
232 | (*pkt)[6] = 0x08; |
288 | memcpy (&(*pkt)[6], &local_mac, sizeof (mac)); |
233 | (*pkt)[7] = 0x00; |
|
|
234 | (*pkt)[8] = 0x58; |
|
|
235 | (*pkt)[9] = 0x00; |
|
|
236 | (*pkt)[10] = 0x00; |
|
|
237 | (*pkt)[11] = 0x01; |
|
|
238 | |
289 | |
239 | if (pkt->is_arp ()) |
290 | if (pkt->is_arp ()) |
240 | { |
291 | { |
241 | if ((*pkt)[22] == 0xfe && (*pkt)[27] == THISNODE->id) |
292 | if ((*pkt)[22] == 0xfe && (*pkt)[27] == THISNODE->id) |
242 | memcpy (&(*pkt)[22], &(*pkt)[6], sizeof (mac)); |
293 | memcpy (&(*pkt)[22], &local_mac, sizeof (mac)); |
243 | |
294 | |
244 | if ((*pkt)[32] == 0xfe && (*pkt)[37] == THISNODE->id) |
295 | if ((*pkt)[32] == 0xfe && (*pkt)[37] == THISNODE->id) |
245 | memcpy (&(*pkt)[32], &(*pkt)[6], sizeof (mac)); |
296 | memcpy (&(*pkt)[32], &local_mac, sizeof (mac)); |
246 | } |
297 | } |
247 | |
298 | |
248 | if (write (fd, &((*pkt)[0]), pkt->len) < 0) |
299 | DWORD dlen; |
249 | slog (L_ERR, _("can't write to %s %s: %s"), info (), conf.ifname, |
300 | OVERLAPPED overlapped; |
250 | strerror (errno)); |
301 | overlapped.hEvent = send_event; |
251 | } |
|
|
252 | |
302 | |
253 | #if 0 |
303 | if (!WriteFile (device_handle, &((*pkt)[0]), pkt->len, &dlen, &overlapped)) |
254 | |
|
|
255 | slog (L_DEBUG, _indent: Standard input:377: Error:Stmt nesting error. |
|
|
256 | ("Tap reader running")); |
|
|
257 | |
|
|
258 | /* Read from tap device and send to parent */ |
|
|
259 | |
|
|
260 | overlapped.hEvent = CreateEvent (NULL, TRUE, FALSE, NULL); |
|
|
261 | |
|
|
262 | for indent |
|
|
263 | : Standard input: 320: Error:Stmt nesting error.(;; |
|
|
264 | ) |
|
|
265 | { |
|
|
266 | overlapped.Offset = 0; |
|
|
267 | overlapped.OffsetHigh = 0; |
|
|
268 | ResetEvent (overlapped.hEvent); |
|
|
269 | |
|
|
270 | status = ReadFile (device_handle, buf, sizeof (buf), &len, &overlapped); |
|
|
271 | |
|
|
272 | if (!status) |
|
|
273 | { |
304 | { |
274 | if (GetLastError () == ERROR_IO_PENDING) |
305 | if (GetLastError () == ERROR_IO_PENDING) |
275 | { |
|
|
276 | WaitForSingleObject (overlapped.hEvent, INFINITE); |
|
|
277 | if (!GetOverlappedResult (device_handle, &overlapped, &len, FALSE)) |
306 | GetOverlappedResult (device_handle, &overlapped, &dlen, TRUE); |
278 | continue; |
|
|
279 | } |
|
|
280 | else |
307 | else |
281 | { |
308 | slog (L_ERR, _("WIN32 TAP: can't write to %s %s: %s"), info (), conf.ifname, |
282 | slog (L_ERR, _("Error while reading from %s %s: %s"), |
309 | wstrerror (GetLastError ())); |
283 | device_info, device, strerror (errno)); |
|
|
284 | return -1; |
|
|
285 | } |
|
|
286 | } |
|
|
287 | |
|
|
288 | if (send (sock, buf, len, 0) <= 0) |
|
|
289 | return -1; |
|
|
290 | } |
|
|
291 | } |
|
|
292 | |
|
|
293 | void |
|
|
294 | close_device (void) |
|
|
295 | { |
|
|
296 | cp (); |
|
|
297 | |
|
|
298 | CloseHandle (device_handle); |
|
|
299 | } |
|
|
300 | |
|
|
301 | bool |
|
|
302 | read_packet (vpn_packet_t * packet) |
|
|
303 | { |
|
|
304 | int lenin; |
|
|
305 | |
|
|
306 | cp (); |
|
|
307 | |
|
|
308 | if ((lenin = recv (device_fd, packet->data, MTU, 0)) <= 0) |
|
|
309 | { |
310 | } |
310 | slog (L_ERR, _("Error while reading from %s %s: %s"), device_info, |
|
|
311 | device, strerror (errno)); |
|
|
312 | return false; |
|
|
313 | } |
|
|
314 | |
|
|
315 | packet->len = lenin; |
|
|
316 | |
|
|
317 | device_total_in += packet->len; |
|
|
318 | |
|
|
319 | ifdebug (TRAFFIC) slog (L_DEBUG, _("Read packet of %d bytes from %s"), |
|
|
320 | packet->len, device_info); |
|
|
321 | |
|
|
322 | return true; |
|
|
323 | } |
311 | } |
324 | |
|
|
325 | bool |
|
|
326 | write_packet (vpn_packet_t * packet) |
|
|
327 | { |
|
|
328 | long lenout; |
|
|
329 | OVERLAPPED overlapped = { 0 }; |
|
|
330 | |
|
|
331 | cp (); |
|
|
332 | |
|
|
333 | ifdebug (TRAFFIC) slog (L_DEBUG, _("Writing packet of %d bytes to %s"), |
|
|
334 | packet->len, device_info); |
|
|
335 | |
|
|
336 | if (!WriteFile |
|
|
337 | (device_handle, packet->data, packet->len, &lenout, &overlapped)) |
|
|
338 | { |
|
|
339 | slog (L_ERR, _("Error while writing to %s %s: %s"), device_info, |
|
|
340 | device, wstrerror (GetLastError ())); |
|
|
341 | return false; |
|
|
342 | } |
|
|
343 | |
|
|
344 | device_total_out += packet->len; |
|
|
345 | |
|
|
346 | return true; |
|
|
347 | } |
|
|
348 | |
|
|
349 | void |
|
|
350 | dump_device_stats (void) |
|
|
351 | { |
|
|
352 | cp (); |
|
|
353 | |
|
|
354 | slog (L_DEBUG, _("Statistics for %s %s:"), device_info, device); |
|
|
355 | slog (L_DEBUG, _(" total bytes in: %10d"), device_total_in); |
|
|
356 | slog (L_DEBUG, _(" total bytes out: %10d"), device_total_out); |
|
|
357 | } |
|
|
358 | #endif |
|
|