ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/device-cygwin.C
(Generate patch)

Comparing gvpe/src/device-cygwin.C (file contents):
Revision 1.3 by pcg, Wed Oct 15 00:25:15 2003 UTC vs.
Revision 1.8 by pcg, Thu Jan 29 18:55:10 2004 UTC

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
28// a newer driver is available as part of the openvpn package: 28// a newer driver is available as part of the openvpn package:
29// http://openvpn.sf.net/ 29// http://openvpn.sf.net/
30 30
31#include "config.h" 31#include "config.h"
32 32
33#include <stdio.h> 33#include <cstdio>
34#include <cstring>
35#include <cstdlib>
34#include <errno.h> 36#include <errno.h>
35#include <sys/types.h> 37#include <sys/types.h>
36#include <sys/stat.h> 38#include <sys/stat.h>
37#include <fcntl.h> 39#include <fcntl.h>
38#include <unistd.h> 40#include <unistd.h>
39#include <syslog.h>
40#include <cstring>
41 41
42#include "conf.h" 42#include "conf.h"
43#include "util.h" 43#include "util.h"
44 44
45#include <io.h>
45#include <w32api/windows.h> 46#include <w32api/windows.h>
46#include <w32api/winioctl.h> 47#include <w32api/winioctl.h>
47 48
48#define REG_CONTROL_NET "SYSTEM\\CurrentControlSet\\Control\\Network\\{4D36E972-E325-11CE-BFC1-08002BE10318}" 49#define REG_CONTROL_NET "SYSTEM\\CurrentControlSet\\Control\\Network\\{4D36E972-E325-11CE-BFC1-08002BE10318}"
49 50
51#define USERDEVICEDIR "\\??\\" 52#define USERDEVICEDIR "\\??\\"
52#define TAPSUFFIX ".tap" 53#define TAPSUFFIX ".tap"
53 54
54#define TAP_CONTROL_CODE(request,method) CTL_CODE(FILE_DEVICE_PHYSICAL_NETCARD | 8000, request, method, FILE_ANY_ACCESS) 55#define TAP_CONTROL_CODE(request,method) CTL_CODE(FILE_DEVICE_PHYSICAL_NETCARD | 8000, request, method, FILE_ANY_ACCESS)
55 56
56#define TAP_IOCTL_GET_LASTMAC TAP_CONTROL_CODE(0, METHOD_BUFFERED) 57#define TAP_IOCTL_GET_LASTMAC TAP_CONTROL_CODE(0, METHOD_BUFFERED)
57#define TAP_IOCTL_GET_MAC TAP_CONTROL_CODE(1, METHOD_BUFFERED) 58#define TAP_IOCTL_GET_MAC TAP_CONTROL_CODE(1, METHOD_BUFFERED)
58#define TAP_IOCTL_SET_STATISTICS TAP_CONTROL_CODE(2, METHOD_BUFFERED) 59#define TAP_IOCTL_SET_STATISTICS TAP_CONTROL_CODE(2, METHOD_BUFFERED)
59 60#define TAP_IOCTL_SET_MEDIA_STATUS TAP_CONTROL_CODE(7, METHOD_BUFFERED)
60static HANDLE device_handle = INVALID_HANDLE_VALUE;
61 61
62static const char * 62static const char *
63wstrerror (int err) 63wstrerror (int err)
64{ 64{
65 static char buf[1024]; 65 static char buf[1024];
69 MAKELANGID (LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof (buf), NULL)) 69 MAKELANGID (LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof (buf), NULL))
70 { 70 {
71 strncpy (buf, _("(unable to format errormessage)"), sizeof (buf)); 71 strncpy (buf, _("(unable to format errormessage)"), sizeof (buf));
72 }; 72 };
73 73
74 char *nl;
74 if ((char *newline = strchr (buf, '\r'))) 75 if ((nl = strchr (buf, '\r')))
75 *newline = '\0'; 76 *nl = '\0';
76 77
77 return buf; 78 return buf;
79}
80
81static HANDLE device_handle = INVALID_HANDLE_VALUE;
82static mac local_mac;
83static tap_packet *rcv_pkt;
84static int iopipe[2];
85static HANDLE pipe_handle, send_event, thread;
86
87static DWORD WINAPI
88read_thread(void *)
89{
90 static OVERLAPPED overlapped;
91 static DWORD dlen;
92 static u32 len;
93 static u8 data[MAX_MTU];
94
95 overlapped.hEvent = CreateEvent (NULL, FALSE, FALSE, NULL);
96
97 for (;;)
98 {
99 if (!ReadFile (device_handle, data, MAX_MTU, &dlen, &overlapped))
100 {
101 if (GetLastError () == ERROR_IO_PENDING)
102 GetOverlappedResult (device_handle, &overlapped, &dlen, TRUE);
103 else
104 {
105 slog (L_ERR, "WIN32 TAP: ReadFile returned error: %s", wstrerror (GetLastError ()));
106 exit (EXIT_FAILURE);
107 }
108 }
109
110 if (dlen > 0)
111 {
112 len = dlen;
113 WriteFile (pipe_handle, &len, sizeof (len), &dlen, NULL);
114 WriteFile (pipe_handle, data, len, &dlen, NULL);
115 }
116 }
78} 117}
79 118
80const char * 119const char *
81tap_device::info () 120tap_device::info ()
82{ 121{
88 HKEY key, key2; 127 HKEY key, key2;
89 int i; 128 int i;
90 129
91 char regpath[1024]; 130 char regpath[1024];
92 char adapterid[1024]; 131 char adapterid[1024];
93 char adaptername[1024]; 132 BYTE adaptername[1024];
94 char tapname[1024]; 133 char tapname[1024];
95 long len; 134 DWORD len;
96 135
97 bool found = false; 136 bool found = false;
98 137
99 int sock, err; 138 int sock, err;
100 139
101 /* Open registry and look for network adapters */ 140 /* Open registry and look for network adapters */
102 141
103 if (RegOpenKeyEx (HKEY_LOCAL_MACHINE, REG_CONTROL_NET, 0, KEY_READ, &key)) 142 if (RegOpenKeyEx (HKEY_LOCAL_MACHINE, REG_CONTROL_NET, 0, KEY_READ, &key))
104 { 143 {
105 slog (L_ERR, _("Unable to read registry: %s"), 144 slog (L_ERR, _("WIN32 TAP: unable to read registry: %s"),
106 wstrerror (GetLastError ())); 145 wstrerror (GetLastError ()));
107 return false; 146 exit (EXIT_FAILURE);
108 } 147 }
109 148
110 for (i = 0;; i++) 149 for (i = 0;; i++)
111 { 150 {
112 len = sizeof (adapterid); 151 len = sizeof (adapterid);
127 RegCloseKey (key2); 166 RegCloseKey (key2);
128 167
129 if (err) 168 if (err)
130 continue; 169 continue;
131 170
171 if (conf.ifname)
172 {
132 if (strcmp (conf.ifname, adapterid)) 173 if (strcmp (conf.ifname, adapterid))
133 continue; 174 continue;
134 175 }
176 else
177 {
135 found = true; 178 found = true;
136 break; 179 break;
180 }
137 181
138 snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, 182 snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, adapterid);
139 adapterid); 183 device_handle = CreateFile(tapname, GENERIC_WRITE | GENERIC_READ, 0, 0,
140 device_handle = CreateFile (tapname, GENERIC_WRITE | GENERIC_READ, 0, 0, OPEN_EXISTING, indent: Standard input: 237: Error:Stmt nesting error.FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 184 OPEN_EXISTING, FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0);
141 0);
142 if (device_handle != INVALID_HANDLE_VALUE) 185 if (device_handle != INVALID_HANDLE_VALUE)
143 { 186 {
144 found = true; 187 found = true;
145 break; 188 break;
146 } 189 }
148 191
149 RegCloseKey (key); 192 RegCloseKey (key);
150 193
151 if (!found) 194 if (!found)
152 { 195 {
153 slog (L_ERR, _("No Windows tap device found!")); 196 slog (L_ERR, _("WIN32 TAP: no windows tap device found!"));
154 return false; 197 exit (EXIT_FAILURE);
155 } 198 }
156
157 if (!device)
158 device = xstrdup (adapterid);
159
160 if (!iface)
161 iface = xstrdup (adaptername);
162 199
163 /* Try to open the corresponding tap device */ 200 /* Try to open the corresponding tap device */
164 201
165 if (device_handle == INVALID_HANDLE_VALUE) 202 if (device_handle == INVALID_HANDLE_VALUE)
166 { 203 {
167 snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, 204 snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, adapterid);
168 device);
169 device_handle = 205 device_handle =
170 CreateFile (tapname, GENERIC_WRITE | GENERIC_READ, 0, 0, 206 CreateFile (tapname, GENERIC_WRITE | GENERIC_READ, 0, 0,
171 OPEN_EXISTING, 207 OPEN_EXISTING,
172 FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0); 208 FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0);
173 } 209 }
174 210
175 if (device_handle == INVALID_HANDLE_VALUE) 211 if (device_handle == INVALID_HANDLE_VALUE)
176 { 212 {
177 slog (L_ERR, _("%s (%s) is not a usable Windows tap device: %s"), 213 slog (L_ERR, _("WIN32 TAP: %s is not a usable windows tap device %s: %s"),
178 device, iface, wstrerror (GetLastError ())); 214 adaptername, tapname, wstrerror (GetLastError ()));
179 return false; 215 exit (EXIT_FAILURE);
180 } 216 }
217
218 strcpy (ifrname, (char *)tapname);
181 219
182 /* Get MAC address from tap device */ 220 /* Get MAC address from tap device */
183 221
184 if (!DeviceIoControl 222 if (!DeviceIoControl (device_handle, TAP_IOCTL_GET_MAC,
185 (device_handle, TAP_IOCTL_GET_MAC, mymac.x, sizeof (mymac.x), mymac.x, 223 &local_mac, sizeof (local_mac), &local_mac, sizeof (local_mac),
186 sizeof (mymac.x), &len, 0)) 224 &len, 0))
187 { 225 {
188 slog (L_ERR, 226 slog (L_ERR,
189 _
190 ("Could not get MAC address from Windows tap device %s (%s): %s"), 227 _("WIN32 TAP: could not get MAC address from windows tap device %s: %s"),
191 device, iface, wstrerror (GetLastError ())); 228 adaptername, wstrerror (GetLastError ()));
192 return false; 229 exit (EXIT_FAILURE);
193 }
194
195 if (routing_mode == RMODE_ROUTER)
196 { 230 }
197 overwrite_mac = 1;
198 }
199 231
200 /* Create a listening socket */ 232 pipe (iopipe);
233 fd = iopipe[0];
234 pipe_handle = (HANDLE) get_osfhandle (iopipe[1]);
201 235
202 err = getaddrinfo (NULL, myport, &hint, &ai); 236 send_event = CreateEvent (NULL, FALSE, FALSE, NULL);
203 237
204 if (err || !ai)
205 {
206 slog (L_ERR, _("System call `%s' failed: %s"), "getaddrinfo",
207 gai_strerror (errno));
208 return false;
209 }
210
211 sock = socket (ai->ai_family, ai->ai_socktype, ai->ai_protocol);
212
213 if (sock < 0)
214 {
215 slog (L_ERR, _("System call `%s' failed: %s"), "socket",
216 strerror (errno));
217 return false;
218 }
219
220 if (bind (sock, ai->ai_addr, ai->ai_addrlen))
221 {
222 slog (L_ERR, _("System call `%s' failed: %s"), "bind",
223 strerror (errno));
224 return false;
225 }
226
227 freeaddrinfo (ai);
228
229 if (listen (sock, 1))
230 {
231 slog (L_ERR, _("System call `%s' failed: %s"), "listen",
232 strerror (errno));
233 return false;
234 }
235
236 /* Start the tap reader */
237
238 thread = CreateThread (NULL, 0, tapreader, NULL, 0, NULL); 238 thread = CreateThread (NULL, 0, read_thread, NULL, 0, NULL);
239 239
240 if (!thread) 240 /* try to set driver media status to 'connected' */
241 { 241 ULONG status = TRUE;
242 slog (L_ERR, _("System call `%s' failed: %s"), "CreateThread", 242 DeviceIoControl (device_handle, TAP_IOCTL_SET_MEDIA_STATUS,
243 wstrerror (GetLastError ())); 243 &status, sizeof (status),
244 return false; 244 &status, sizeof (status), &len, NULL);
245 } 245 // ignore error here on purpose
246
247 /* Wait for the tap reader to connect back to us */
248
249 if ((device_fd = accept (sock, NULL, 0)) == -1)
250 {
251 slog (L_ERR, _("System call `%s' failed: %s"), "accept",
252 strerror (errno));
253 return false;
254 }
255
256 closesocket (sock);
257
258 device_info = _("Windows tap device");
259
260 slog (L_INFO, _("%s (%s) is a %s"), device, iface, device_info);
261
262 return true;
263}
264
265} 246}
266 247
267tap_device::~tap_device () 248tap_device::~tap_device ()
268{ 249{
269 close (fd); 250 close (iopipe[0]);
251 close (iopipe[1]);
252 CloseHandle (device_handle);
253 CloseHandle (send_event);
270} 254}
271 255
272tap_packet * 256tap_packet *
273tap_device::recv () 257tap_device::recv ()
274{ 258{
275 tap_packet *pkt = new tap_packet; 259 tap_packet *pkt = new tap_packet;
276 260
277 pkt->len = read (fd, &((*pkt)[0]), MAX_MTU); 261 if (sizeof (u32) != read (iopipe[0], &pkt->len, sizeof (u32)))
278
279 if (pkt->len <= 0)
280 { 262 {
281 slog (L_ERR, _("error while reading from %s %s: %s"), 263 slog (L_ERR, _("WIN32 TAP: i/o thread delivered incomplete pkt length"));
282 info (), conf.ifname, strerror (errno)); 264 delete pkt;
283 free (pkt);
284 return 0; 265 return 0;
285 } 266 }
286 267
268 if (pkt->len != read (iopipe[0], &((*pkt)[0]), pkt->len))
269 {
270 slog (L_ERR, _("WIN32 TAP: i/o thread delivered incomplete pkt"));
271 delete pkt;
272 return 0;
273 }
274
287 id2mac (THISNODE->id, &((*pkt)[6])); 275 id2mac (THISNODE->id, &((*pkt)[6]));
288 276
289 if (pkt->is_arp ()) 277 if (pkt->is_arp ())
290 { 278 {
291 if ((*pkt)[22] == 0x08) 279 if (!memcmp (&(*pkt)[22], &local_mac, sizeof (mac))) id2mac (THISNODE->id, &((*pkt)[22]));
292 id2mac (THISNODE->id, &((*pkt)[22])); 280 if (!memcmp (&(*pkt)[32], &local_mac, sizeof (mac))) id2mac (THISNODE->id, &((*pkt)[32]));
293 if ((*pkt)[32] == 0x08)
294 id2mac (THISNODE->id, &((*pkt)[32]));
295 } 281 }
296 282
297 return pkt; 283 return pkt;
298} 284}
299 285
300void 286void
301tap_device::send (tap_packet * pkt) 287tap_device::send (tap_packet * pkt)
302{ 288{
303 (*pkt)[6] = 0x08; 289 memcpy (&(*pkt)[6], &local_mac, sizeof (mac));
304 (*pkt)[7] = 0x00;
305 (*pkt)[8] = 0x58;
306 (*pkt)[9] = 0x00;
307 (*pkt)[10] = 0x00;
308 (*pkt)[11] = 0x01;
309 290
310 if (pkt->is_arp ()) 291 if (pkt->is_arp ())
311 { 292 {
312 if ((*pkt)[22] == 0xfe && (*pkt)[27] == THISNODE->id) 293 if ((*pkt)[22] == 0xfe && (*pkt)[27] == THISNODE->id)
313 memcpy (&(*pkt)[22], &(*pkt)[6], sizeof (mac)); 294 memcpy (&(*pkt)[22], &local_mac, sizeof (mac));
314 295
315 if ((*pkt)[32] == 0xfe && (*pkt)[37] == THISNODE->id) 296 if ((*pkt)[32] == 0xfe && (*pkt)[37] == THISNODE->id)
316 memcpy (&(*pkt)[32], &(*pkt)[6], sizeof (mac)); 297 memcpy (&(*pkt)[32], &local_mac, sizeof (mac));
317 } 298 }
318 299
319 if (write (fd, &((*pkt)[0]), pkt->len) < 0) 300 DWORD dlen;
320 slog (L_ERR, _("can't write to %s %s: %s"), info (), conf.ifname, 301 OVERLAPPED overlapped;
321 strerror (errno)); 302 overlapped.hEvent = send_event;
322}
323 303
324#if 0 304 if (!WriteFile (device_handle, &((*pkt)[0]), pkt->len, &dlen, &overlapped))
325
326slog (L_DEBUG, _indent: Standard input:377: Error:Stmt nesting error.
327("Tap reader running"));
328
329 /* Read from tap device and send to parent */
330
331overlapped.hEvent = CreateEvent (NULL, TRUE, FALSE, NULL);
332
333for indent
334: Standard input: 320: Error:Stmt nesting error.(;;
335 )
336{
337 overlapped.Offset = 0;
338 overlapped.OffsetHigh = 0;
339 ResetEvent (overlapped.hEvent);
340
341 status = ReadFile (device_handle, buf, sizeof (buf), &len, &overlapped);
342
343 if (!status)
344 { 305 {
345 if (GetLastError () == ERROR_IO_PENDING) 306 if (GetLastError () == ERROR_IO_PENDING)
346 {
347 WaitForSingleObject (overlapped.hEvent, INFINITE);
348 if (!GetOverlappedResult (device_handle, &overlapped, &len, FALSE)) 307 GetOverlappedResult (device_handle, &overlapped, &dlen, TRUE);
349 continue;
350 }
351 else 308 else
352 { 309 slog (L_ERR, _("WIN32 TAP: can't write to %s %s: %s"), info (), conf.ifname,
353 slog (L_ERR, _("Error while reading from %s %s: %s"), 310 wstrerror (GetLastError ()));
354 device_info, device, strerror (errno));
355 return -1;
356 }
357 }
358
359 if (send (sock, buf, len, 0) <= 0)
360 return -1;
361}
362}
363
364void
365close_device (void)
366{
367 cp ();
368
369 CloseHandle (device_handle);
370}
371
372bool
373read_packet (vpn_packet_t * packet)
374{
375 int lenin;
376
377 cp ();
378
379 if ((lenin = recv (device_fd, packet->data, MTU, 0)) <= 0)
380 { 311 }
381 slog (L_ERR, _("Error while reading from %s %s: %s"), device_info,
382 device, strerror (errno));
383 return false;
384 }
385
386 packet->len = lenin;
387
388 device_total_in += packet->len;
389
390 ifdebug (TRAFFIC) slog (L_DEBUG, _("Read packet of %d bytes from %s"),
391 packet->len, device_info);
392
393 return true;
394} 312}
395
396bool
397write_packet (vpn_packet_t * packet)
398{
399 long lenout;
400 OVERLAPPED overlapped = { 0 };
401
402 cp ();
403
404 ifdebug (TRAFFIC) slog (L_DEBUG, _("Writing packet of %d bytes to %s"),
405 packet->len, device_info);
406
407 if (!WriteFile
408 (device_handle, packet->data, packet->len, &lenout, &overlapped))
409 {
410 slog (L_ERR, _("Error while writing to %s %s: %s"), device_info,
411 device, wstrerror (GetLastError ()));
412 return false;
413 }
414
415 device_total_out += packet->len;
416
417 return true;
418}
419
420void
421dump_device_stats (void)
422{
423 cp ();
424
425 slog (L_DEBUG, _("Statistics for %s %s:"), device_info, device);
426 slog (L_DEBUG, _(" total bytes in: %10d"), device_total_in);
427 slog (L_DEBUG, _(" total bytes out: %10d"), device_total_out);
428}
429#endif

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines