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.5 by pcg, Wed Oct 15 01:38:24 2003 UTC vs.
Revision 1.6 by pcg, Wed Oct 15 06:06:41 2003 UTC

… …
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)
60static HANDLE device_handle = INVALID_HANDLE_VALUE;
61static mac my_mac;
62 60
63static const char * 61static const char *
64wstrerror (int err) 62wstrerror (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
80static HANDLE device_handle = INVALID_HANDLE_VALUE;
81static mac local_mac;
82static tap_packet *rcv_pkt;
83static int iopipe[2];
84static HANDLE pipe_handle, send_event, thread;
85
86static DWORD WINAPI
87read_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
81const char * 118const char *
82tap_device::info () 119tap_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
196tap_device::~tap_device () 247tap_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
201tap_packet * 255tap_packet *
202tap_device::recv () 256tap_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
229void 285void
230tap_device::send (tap_packet * pkt) 286tap_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
255slog (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
260overlapped.hEvent = CreateEvent (NULL, TRUE, FALSE, NULL);
261
262for 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
293void
294close_device (void)
295{
296 cp ();
297
298 CloseHandle (device_handle);
299}
300
301bool
302read_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
325bool
326write_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
349void
350dump_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

Diff Legend

– Removed lines
+ Added lines
< Changed lines
> Changed lines