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-2005 Marc Lehmann <ocg@goof.com> |
|
|
4 | Copyright (C) 2002-2003 Ivo Timmermans <ivo@o2w.nl>, |
|
|
5 | 2002-2003 Guus Sliepen <guus@sliepen.eu.org> |
4 | |
6 | |
|
|
7 | This file is part of GVPE. |
|
|
8 | |
5 | This program is free software; you can redistribute it and/or modify |
9 | GVPE is free software; you can redistribute it and/or modify |
6 | it under the terms of the GNU General Public License as published by |
10 | it under the terms of the GNU General Public License as published by |
7 | the Free Software Foundation; either version 2 of the License, or |
11 | the Free Software Foundation; either version 2 of the License, or |
8 | (at your option) any later version. |
12 | (at your option) any later version. |
9 | |
13 | |
10 | This program is distributed in the hope that it will be useful, |
14 | This program is distributed in the hope that it will be useful, |
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
15 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
13 | GNU General Public License for more details. |
17 | GNU General Public License for more details. |
14 | |
18 | |
15 | You should have received a copy of the GNU General Public License |
19 | You should have received a copy of the GNU General Public License |
16 | along with this program; if not, write to the Free Software |
20 | along with gvpe; if not, write to the Free Software |
17 | Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
21 | Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
18 | */ |
22 | */ |
19 | |
23 | |
20 | // unfortunately, there is be no way to set MAC addresses under windows, |
24 | // unfortunately, there is be no way to set MAC addresses under windows, |
21 | // and the default cipedrvr uses a different MAC address than we do, |
25 | // and the default cipedrvr uses a different MAC address than we do, |
22 | // so this module tries to fix mac addresses in packets and arp packets. |
26 | // so this module tries to fix mac addresses in packets and arp packets. |
23 | // this is probably not very fast, but neither is cygwin nor poll. |
27 | // this is probably not very fast, but neither is cygwin nor poll. |
24 | // |
28 | // |
25 | // http://cipe-win32.sourceforge.net/ |
29 | // http://cipe-win32.sourceforge.net/ |
|
|
30 | // a newer driver is available as part of the openvpn package: |
|
|
31 | // http://openvpn.sf.net/ |
26 | |
32 | |
27 | #include "config.h" |
33 | #include "config.h" |
28 | |
34 | |
29 | #include <stdio.h> |
35 | #include <cstdio> |
|
|
36 | #include <cstring> |
|
|
37 | #include <cstdlib> |
30 | #include <errno.h> |
38 | #include <errno.h> |
31 | #include <sys/types.h> |
39 | #include <sys/types.h> |
32 | #include <sys/stat.h> |
40 | #include <sys/stat.h> |
33 | #include <fcntl.h> |
41 | #include <fcntl.h> |
34 | #include <unistd.h> |
42 | #include <unistd.h> |
35 | #include <syslog.h> |
|
|
36 | #include <cstring> |
|
|
37 | |
43 | |
38 | #include "conf.h" |
44 | #include "conf.h" |
39 | #include "util.h" |
45 | #include "util.h" |
40 | |
46 | |
|
|
47 | #include <io.h> |
|
|
48 | #include <w32api/windows.h> |
|
|
49 | #include <w32api/winioctl.h> |
|
|
50 | |
|
|
51 | #define REG_CONTROL_NET "SYSTEM\\CurrentControlSet\\Control\\Network\\{4D36E972-E325-11CE-BFC1-08002BE10318}" |
|
|
52 | |
|
|
53 | #define USERMODEDEVICEDIR "\\\\.\\" |
|
|
54 | #define USERDEVICEDIR "\\??\\" |
|
|
55 | #define TAPSUFFIX ".tap" |
|
|
56 | |
|
|
57 | #define TAP_CONTROL_CODE(request,method) CTL_CODE(FILE_DEVICE_PHYSICAL_NETCARD | 8000, request, method, FILE_ANY_ACCESS) |
|
|
58 | |
|
|
59 | #define TAP_IOCTL_GET_LASTMAC TAP_CONTROL_CODE(0, METHOD_BUFFERED) |
|
|
60 | #define TAP_IOCTL_GET_MAC TAP_CONTROL_CODE(1, METHOD_BUFFERED) |
|
|
61 | #define TAP_IOCTL_SET_STATISTICS TAP_CONTROL_CODE(2, METHOD_BUFFERED) |
|
|
62 | #define TAP_IOCTL_SET_MEDIA_STATUS TAP_CONTROL_CODE(7, METHOD_BUFFERED) |
|
|
63 | |
|
|
64 | static const char * |
|
|
65 | wstrerror (int err) |
|
|
66 | { |
|
|
67 | static char buf[1024]; |
|
|
68 | |
|
|
69 | if (!FormatMessage |
|
|
70 | (FORMAT_MESSAGE_FROM_SYSTEM | FORMAT_MESSAGE_IGNORE_INSERTS, NULL, err, |
|
|
71 | MAKELANGID (LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof (buf), NULL)) |
|
|
72 | { |
|
|
73 | strncpy (buf, _("(unable to format errormessage)"), sizeof (buf)); |
|
|
74 | }; |
|
|
75 | |
|
|
76 | char *nl; |
|
|
77 | if ((nl = strchr (buf, '\r'))) |
|
|
78 | *nl = '\0'; |
|
|
79 | |
|
|
80 | return buf; |
|
|
81 | } |
|
|
82 | |
|
|
83 | static HANDLE device_handle = INVALID_HANDLE_VALUE; |
|
|
84 | static mac local_mac; |
|
|
85 | static tap_packet *rcv_pkt; |
|
|
86 | static int iopipe[2]; |
|
|
87 | static HANDLE pipe_handle, send_event, thread; |
|
|
88 | |
|
|
89 | static DWORD WINAPI |
|
|
90 | read_thread(void *) |
|
|
91 | { |
|
|
92 | static OVERLAPPED overlapped; |
|
|
93 | static DWORD dlen; |
|
|
94 | static u32 len; |
|
|
95 | static u8 data[MAX_MTU]; |
|
|
96 | |
|
|
97 | overlapped.hEvent = CreateEvent (NULL, FALSE, FALSE, NULL); |
|
|
98 | |
|
|
99 | for (;;) |
|
|
100 | { |
|
|
101 | if (!ReadFile (device_handle, data, MAX_MTU, &dlen, &overlapped)) |
|
|
102 | { |
|
|
103 | if (GetLastError () == ERROR_IO_PENDING) |
|
|
104 | GetOverlappedResult (device_handle, &overlapped, &dlen, TRUE); |
|
|
105 | else |
|
|
106 | { |
|
|
107 | slog (L_ERR, "WIN32 TAP: ReadFile returned error: %s", wstrerror (GetLastError ())); |
|
|
108 | exit (EXIT_FAILURE); |
|
|
109 | } |
|
|
110 | } |
|
|
111 | |
|
|
112 | if (dlen > 0) |
|
|
113 | { |
|
|
114 | len = dlen; |
|
|
115 | WriteFile (pipe_handle, &len, sizeof (len), &dlen, NULL); |
|
|
116 | WriteFile (pipe_handle, data, len, &dlen, NULL); |
|
|
117 | } |
|
|
118 | } |
|
|
119 | } |
|
|
120 | |
|
|
121 | const char * |
|
|
122 | tap_device::info () |
|
|
123 | { |
|
|
124 | return _("cygwin cipe/openvpn tap device"); |
|
|
125 | } |
|
|
126 | |
|
|
127 | const char * |
|
|
128 | tap_device::if_up () |
|
|
129 | { |
|
|
130 | return ""; |
|
|
131 | } |
|
|
132 | |
41 | tap_device::tap_device () |
133 | tap_device::tap_device () |
42 | { |
134 | { |
43 | if ((fd = open (conf.ifname, O_RDWR)) < 0) |
135 | HKEY key, key2; |
44 | { |
136 | int i; |
45 | slog (L_CRIT, _("could not open %s: %s"), conf.ifname, strerror (errno)); |
137 | |
46 | exit (1); |
138 | char regpath[1024]; |
|
|
139 | char adapterid[1024]; |
|
|
140 | BYTE adaptername[1024]; |
|
|
141 | char tapname[1024]; |
|
|
142 | DWORD len; |
|
|
143 | |
|
|
144 | bool found = false; |
|
|
145 | |
|
|
146 | int sock, err; |
|
|
147 | |
|
|
148 | /* Open registry and look for network adapters */ |
|
|
149 | |
|
|
150 | if (RegOpenKeyEx (HKEY_LOCAL_MACHINE, REG_CONTROL_NET, 0, KEY_READ, &key)) |
47 | } |
151 | { |
|
|
152 | slog (L_ERR, _("WIN32 TAP: unable to read registry: %s"), |
|
|
153 | wstrerror (GetLastError ())); |
|
|
154 | exit (EXIT_FAILURE); |
|
|
155 | } |
|
|
156 | |
|
|
157 | for (i = 0;; i++) |
|
|
158 | { |
|
|
159 | len = sizeof (adapterid); |
|
|
160 | if (RegEnumKeyEx (key, i, adapterid, &len, 0, 0, 0, NULL)) |
|
|
161 | break; |
|
|
162 | |
|
|
163 | /* Find out more about this adapter */ |
|
|
164 | |
|
|
165 | snprintf (regpath, sizeof (regpath), "%s\\%s\\Connection", |
|
|
166 | REG_CONTROL_NET, adapterid); |
|
|
167 | |
|
|
168 | if (RegOpenKeyEx (HKEY_LOCAL_MACHINE, regpath, 0, KEY_READ, &key2)) |
|
|
169 | continue; |
|
|
170 | |
|
|
171 | len = sizeof (adaptername); |
|
|
172 | err = RegQueryValueEx (key2, "Name", 0, 0, adaptername, &len); |
|
|
173 | |
|
|
174 | RegCloseKey (key2); |
|
|
175 | |
|
|
176 | if (err) |
|
|
177 | continue; |
|
|
178 | |
|
|
179 | if (conf.ifname) |
|
|
180 | { |
|
|
181 | if (strcmp (conf.ifname, adapterid)) |
|
|
182 | continue; |
|
|
183 | } |
|
|
184 | else |
|
|
185 | { |
|
|
186 | found = true; |
|
|
187 | break; |
|
|
188 | } |
|
|
189 | |
|
|
190 | snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, adapterid); |
|
|
191 | device_handle = CreateFile(tapname, GENERIC_WRITE | GENERIC_READ, 0, 0, |
|
|
192 | OPEN_EXISTING, FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0); |
|
|
193 | if (device_handle != INVALID_HANDLE_VALUE) |
|
|
194 | { |
|
|
195 | found = true; |
|
|
196 | break; |
|
|
197 | } |
|
|
198 | } |
|
|
199 | |
|
|
200 | RegCloseKey (key); |
|
|
201 | |
|
|
202 | if (!found) |
|
|
203 | { |
|
|
204 | slog (L_ERR, _("WIN32 TAP: no windows tap device found!")); |
|
|
205 | exit (EXIT_FAILURE); |
|
|
206 | } |
|
|
207 | |
|
|
208 | /* Try to open the corresponding tap device */ |
|
|
209 | |
|
|
210 | if (device_handle == INVALID_HANDLE_VALUE) |
|
|
211 | { |
|
|
212 | snprintf (tapname, sizeof (tapname), USERMODEDEVICEDIR "%s" TAPSUFFIX, adapterid); |
|
|
213 | device_handle = |
|
|
214 | CreateFile (tapname, GENERIC_WRITE | GENERIC_READ, 0, 0, |
|
|
215 | OPEN_EXISTING, |
|
|
216 | FILE_ATTRIBUTE_SYSTEM | FILE_FLAG_OVERLAPPED, 0); |
|
|
217 | } |
|
|
218 | |
|
|
219 | if (device_handle == INVALID_HANDLE_VALUE) |
|
|
220 | { |
|
|
221 | slog (L_ERR, _("WIN32 TAP: %s is not a usable windows tap device %s: %s"), |
|
|
222 | adaptername, tapname, wstrerror (GetLastError ())); |
|
|
223 | exit (EXIT_FAILURE); |
|
|
224 | } |
|
|
225 | |
|
|
226 | strcpy (ifrname, (char *)tapname); |
|
|
227 | |
|
|
228 | /* Get MAC address from tap device */ |
|
|
229 | |
|
|
230 | if (!DeviceIoControl (device_handle, TAP_IOCTL_GET_MAC, |
|
|
231 | &local_mac, sizeof (local_mac), &local_mac, sizeof (local_mac), |
|
|
232 | &len, 0)) |
|
|
233 | { |
|
|
234 | slog (L_ERR, |
|
|
235 | _("WIN32 TAP: could not get MAC address from windows tap device %s: %s"), |
|
|
236 | adaptername, wstrerror (GetLastError ())); |
|
|
237 | exit (EXIT_FAILURE); |
|
|
238 | } |
|
|
239 | |
|
|
240 | pipe (iopipe); |
|
|
241 | fd = iopipe[0]; |
|
|
242 | pipe_handle = (HANDLE) get_osfhandle (iopipe[1]); |
|
|
243 | |
|
|
244 | send_event = CreateEvent (NULL, FALSE, FALSE, NULL); |
|
|
245 | |
|
|
246 | thread = CreateThread (NULL, 0, read_thread, NULL, 0, NULL); |
|
|
247 | |
|
|
248 | /* try to set driver media status to 'connected' */ |
|
|
249 | ULONG status = TRUE; |
|
|
250 | DeviceIoControl (device_handle, TAP_IOCTL_SET_MEDIA_STATUS, |
|
|
251 | &status, sizeof (status), |
|
|
252 | &status, sizeof (status), &len, NULL); |
|
|
253 | // ignore error here on purpose |
48 | } |
254 | } |
49 | |
255 | |
50 | tap_device::~tap_device () |
256 | tap_device::~tap_device () |
51 | { |
257 | { |
52 | close (fd); |
258 | close (iopipe[0]); |
|
|
259 | close (iopipe[1]); |
|
|
260 | CloseHandle (device_handle); |
|
|
261 | CloseHandle (send_event); |
53 | } |
262 | } |
54 | |
263 | |
55 | tap_packet * |
264 | tap_packet * |
56 | tap_device::recv () |
265 | tap_device::recv () |
57 | { |
266 | { |
58 | tap_packet *pkt = new tap_packet; |
267 | tap_packet *pkt = new tap_packet; |
59 | |
268 | |
60 | pkt->len = read (fd, &((*pkt)[0]), MAX_MTU); |
269 | if (sizeof (u32) != read (iopipe[0], &pkt->len, sizeof (u32))) |
61 | |
|
|
62 | if (pkt->len <= 0) |
|
|
63 | { |
270 | { |
64 | slog (L_ERR, _("error while reading from %s %s: %s"), |
271 | slog (L_ERR, _("WIN32 TAP: i/o thread delivered incomplete pkt length")); |
65 | info (), conf.ifname, strerror (errno)); |
272 | delete pkt; |
66 | free (pkt); |
|
|
67 | return 0; |
273 | return 0; |
68 | } |
274 | } |
69 | |
275 | |
|
|
276 | if (pkt->len != read (iopipe[0], &((*pkt)[0]), pkt->len)) |
|
|
277 | { |
|
|
278 | slog (L_ERR, _("WIN32 TAP: i/o thread delivered incomplete pkt")); |
|
|
279 | delete pkt; |
|
|
280 | return 0; |
|
|
281 | } |
|
|
282 | |
70 | id2mac (THISNODE->id, &((*pkt)[6])); |
283 | id2mac (THISNODE->id, &((*pkt)[6])); |
71 | |
284 | |
72 | if (pkt->is_arp ()) |
285 | if (pkt->is_arp ()) |
73 | { |
286 | { |
74 | if ((*pkt)[22] == 0x08) id2mac (THISNODE->id, &((*pkt)[22])); |
287 | if (!memcmp (&(*pkt)[22], &local_mac, sizeof (mac))) id2mac (THISNODE->id, &((*pkt)[22])); |
75 | if ((*pkt)[32] == 0x08) id2mac (THISNODE->id, &((*pkt)[32])); |
288 | if (!memcmp (&(*pkt)[32], &local_mac, sizeof (mac))) id2mac (THISNODE->id, &((*pkt)[32])); |
76 | } |
289 | } |
77 | |
290 | |
78 | return pkt; |
291 | return pkt; |
79 | } |
292 | } |
80 | |
293 | |
81 | void |
294 | void |
82 | tap_device::send (tap_packet *pkt) |
295 | tap_device::send (tap_packet * pkt) |
83 | { |
296 | { |
84 | (*pkt)[ 6] = 0x08; (*pkt)[ 7] = 0x00; (*pkt)[ 8] = 0x58; |
297 | memcpy (&(*pkt)[6], &local_mac, sizeof (mac)); |
85 | (*pkt)[ 9] = 0x00; (*pkt)[10] = 0x00; (*pkt)[11] = 0x01; |
|
|
86 | |
298 | |
87 | if (pkt->is_arp ()) |
299 | if (pkt->is_arp ()) |
88 | { |
300 | { |
89 | if ((*pkt)[22] == 0xfe && (*pkt)[27] == THISNODE->id) |
301 | if ((*pkt)[22] == 0xfe && (*pkt)[27] == THISNODE->id) |
90 | memcpy (&(*pkt)[22], &(*pkt)[6], sizeof (mac)); |
302 | memcpy (&(*pkt)[22], &local_mac, sizeof (mac)); |
91 | |
303 | |
92 | if ((*pkt)[32] == 0xfe && (*pkt)[37] == THISNODE->id) |
304 | if ((*pkt)[32] == 0xfe && (*pkt)[37] == THISNODE->id) |
93 | memcpy (&(*pkt)[32], &(*pkt)[6], sizeof (mac)); |
305 | memcpy (&(*pkt)[32], &local_mac, sizeof (mac)); |
|
|
306 | } |
|
|
307 | |
|
|
308 | DWORD dlen; |
|
|
309 | OVERLAPPED overlapped; |
|
|
310 | overlapped.hEvent = send_event; |
|
|
311 | |
|
|
312 | if (!WriteFile (device_handle, &((*pkt)[0]), pkt->len, &dlen, &overlapped)) |
94 | } |
313 | { |
95 | |
314 | if (GetLastError () == ERROR_IO_PENDING) |
96 | if (write (fd, &((*pkt)[0]), pkt->len) < 0) |
315 | GetOverlappedResult (device_handle, &overlapped, &dlen, TRUE); |
|
|
316 | else |
97 | slog (L_ERR, _("can't write to %s %s: %s"), info (), conf.ifname, |
317 | slog (L_ERR, _("WIN32 TAP: can't write to %s %s: %s"), info (), conf.ifname, |
98 | strerror (errno)); |
318 | wstrerror (GetLastError ())); |
|
|
319 | } |
99 | } |
320 | } |