[ViewVC] Diff of: cvs/gvpe/src/device-cygwin.C

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)
60	static HANDLE device_handle = INVALID_HANDLE_VALUE;
61		61
62	static const char *	62	static const char *
63	wstrerror (int err)	63	wstrerror (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
		81	static HANDLE device_handle = INVALID_HANDLE_VALUE;
		82	static mac local_mac;
		83	static tap_packet *rcv_pkt;
		84	static int iopipe[2];
		85	static HANDLE pipe_handle, send_event, thread;
		86
		87	static DWORD WINAPI
		88	read_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
80	const char *	119	const char *
81	tap_device::info ()	120	tap_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
267	tap_device::~tap_device ()	248	tap_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
272	tap_packet *	256	tap_packet *
273	tap_device::recv ()	257	tap_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
300	void	286	void
301	tap_device::send (tap_packet * pkt)	287	tap_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
326	slog (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
331	overlapped.hEvent = CreateEvent (NULL, TRUE, FALSE, NULL);
332
333	for 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
364	void
365	close_device (void)
366	{
367	cp ();
368
369	CloseHandle (device_handle);
370	}
371
372	bool
373	read_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
396	bool
397	write_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
420	void
421	dump_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

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

Diff Legend

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