1 | #include <machine/rtems-bsd-user-space.h> |
---|
2 | |
---|
3 | /* |
---|
4 | * Wired Ethernet driver interface |
---|
5 | * Copyright (c) 2005-2009, Jouni Malinen <j@w1.fi> |
---|
6 | * Copyright (c) 2004, Gunter Burchardt <tira@isx.de> |
---|
7 | * |
---|
8 | * This software may be distributed under the terms of the BSD license. |
---|
9 | * See README for more details. |
---|
10 | */ |
---|
11 | |
---|
12 | #include "includes.h" |
---|
13 | #include <sys/ioctl.h> |
---|
14 | #include <net/if.h> |
---|
15 | #ifdef __linux__ |
---|
16 | #include <netpacket/packet.h> |
---|
17 | #include <net/if_arp.h> |
---|
18 | #include <net/if.h> |
---|
19 | #endif /* __linux__ */ |
---|
20 | #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__) |
---|
21 | #include <net/if_dl.h> |
---|
22 | #include <net/if_media.h> |
---|
23 | #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__) */ |
---|
24 | #ifdef __sun__ |
---|
25 | #include <sys/sockio.h> |
---|
26 | #endif /* __sun__ */ |
---|
27 | |
---|
28 | #include "common.h" |
---|
29 | #include "eloop.h" |
---|
30 | #include "driver.h" |
---|
31 | |
---|
32 | #ifdef _MSC_VER |
---|
33 | #pragma pack(push, 1) |
---|
34 | #endif /* _MSC_VER */ |
---|
35 | |
---|
36 | struct ieee8023_hdr { |
---|
37 | u8 dest[6]; |
---|
38 | u8 src[6]; |
---|
39 | u16 ethertype; |
---|
40 | } STRUCT_PACKED; |
---|
41 | |
---|
42 | #ifdef _MSC_VER |
---|
43 | #pragma pack(pop) |
---|
44 | #endif /* _MSC_VER */ |
---|
45 | |
---|
46 | static const u8 pae_group_addr[ETH_ALEN] = |
---|
47 | { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 }; |
---|
48 | |
---|
49 | |
---|
50 | struct wpa_driver_wired_data { |
---|
51 | char ifname[IFNAMSIZ + 1]; |
---|
52 | void *ctx; |
---|
53 | |
---|
54 | int sock; /* raw packet socket for driver access */ |
---|
55 | int dhcp_sock; /* socket for dhcp packets */ |
---|
56 | int use_pae_group_addr; |
---|
57 | |
---|
58 | int pf_sock; |
---|
59 | int membership, multi, iff_allmulti, iff_up; |
---|
60 | }; |
---|
61 | |
---|
62 | |
---|
63 | /* TODO: detecting new devices should eventually be changed from using DHCP |
---|
64 | * snooping to trigger on any packet from a new layer 2 MAC address, e.g., |
---|
65 | * based on ebtables, etc. */ |
---|
66 | |
---|
67 | struct dhcp_message { |
---|
68 | u_int8_t op; |
---|
69 | u_int8_t htype; |
---|
70 | u_int8_t hlen; |
---|
71 | u_int8_t hops; |
---|
72 | u_int32_t xid; |
---|
73 | u_int16_t secs; |
---|
74 | u_int16_t flags; |
---|
75 | u_int32_t ciaddr; |
---|
76 | u_int32_t yiaddr; |
---|
77 | u_int32_t siaddr; |
---|
78 | u_int32_t giaddr; |
---|
79 | u_int8_t chaddr[16]; |
---|
80 | u_int8_t sname[64]; |
---|
81 | u_int8_t file[128]; |
---|
82 | u_int32_t cookie; |
---|
83 | u_int8_t options[308]; /* 312 - cookie */ |
---|
84 | }; |
---|
85 | |
---|
86 | |
---|
87 | static int wired_multicast_membership(int sock, int ifindex, |
---|
88 | const u8 *addr, int add) |
---|
89 | { |
---|
90 | #ifdef __linux__ |
---|
91 | struct packet_mreq mreq; |
---|
92 | |
---|
93 | if (sock < 0) |
---|
94 | return -1; |
---|
95 | |
---|
96 | os_memset(&mreq, 0, sizeof(mreq)); |
---|
97 | mreq.mr_ifindex = ifindex; |
---|
98 | mreq.mr_type = PACKET_MR_MULTICAST; |
---|
99 | mreq.mr_alen = ETH_ALEN; |
---|
100 | os_memcpy(mreq.mr_address, addr, ETH_ALEN); |
---|
101 | |
---|
102 | if (setsockopt(sock, SOL_PACKET, |
---|
103 | add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP, |
---|
104 | &mreq, sizeof(mreq)) < 0) { |
---|
105 | wpa_printf(MSG_ERROR, "setsockopt: %s", strerror(errno)); |
---|
106 | return -1; |
---|
107 | } |
---|
108 | return 0; |
---|
109 | #else /* __linux__ */ |
---|
110 | return -1; |
---|
111 | #endif /* __linux__ */ |
---|
112 | } |
---|
113 | |
---|
114 | |
---|
115 | #ifdef __linux__ |
---|
116 | static void handle_data(void *ctx, unsigned char *buf, size_t len) |
---|
117 | { |
---|
118 | #ifdef HOSTAPD |
---|
119 | struct ieee8023_hdr *hdr; |
---|
120 | u8 *pos, *sa; |
---|
121 | size_t left; |
---|
122 | union wpa_event_data event; |
---|
123 | |
---|
124 | /* must contain at least ieee8023_hdr 6 byte source, 6 byte dest, |
---|
125 | * 2 byte ethertype */ |
---|
126 | if (len < 14) { |
---|
127 | wpa_printf(MSG_MSGDUMP, "handle_data: too short (%lu)", |
---|
128 | (unsigned long) len); |
---|
129 | return; |
---|
130 | } |
---|
131 | |
---|
132 | hdr = (struct ieee8023_hdr *) buf; |
---|
133 | |
---|
134 | switch (ntohs(hdr->ethertype)) { |
---|
135 | case ETH_P_PAE: |
---|
136 | wpa_printf(MSG_MSGDUMP, "Received EAPOL packet"); |
---|
137 | sa = hdr->src; |
---|
138 | os_memset(&event, 0, sizeof(event)); |
---|
139 | event.new_sta.addr = sa; |
---|
140 | wpa_supplicant_event(ctx, EVENT_NEW_STA, &event); |
---|
141 | |
---|
142 | pos = (u8 *) (hdr + 1); |
---|
143 | left = len - sizeof(*hdr); |
---|
144 | drv_event_eapol_rx(ctx, sa, pos, left); |
---|
145 | break; |
---|
146 | |
---|
147 | default: |
---|
148 | wpa_printf(MSG_DEBUG, "Unknown ethertype 0x%04x in data frame", |
---|
149 | ntohs(hdr->ethertype)); |
---|
150 | break; |
---|
151 | } |
---|
152 | #endif /* HOSTAPD */ |
---|
153 | } |
---|
154 | |
---|
155 | |
---|
156 | static void handle_read(int sock, void *eloop_ctx, void *sock_ctx) |
---|
157 | { |
---|
158 | int len; |
---|
159 | unsigned char buf[3000]; |
---|
160 | |
---|
161 | len = recv(sock, buf, sizeof(buf), 0); |
---|
162 | if (len < 0) { |
---|
163 | wpa_printf(MSG_ERROR, "recv: %s", strerror(errno)); |
---|
164 | return; |
---|
165 | } |
---|
166 | |
---|
167 | handle_data(eloop_ctx, buf, len); |
---|
168 | } |
---|
169 | |
---|
170 | |
---|
171 | static void handle_dhcp(int sock, void *eloop_ctx, void *sock_ctx) |
---|
172 | { |
---|
173 | int len; |
---|
174 | unsigned char buf[3000]; |
---|
175 | struct dhcp_message *msg; |
---|
176 | u8 *mac_address; |
---|
177 | union wpa_event_data event; |
---|
178 | |
---|
179 | len = recv(sock, buf, sizeof(buf), 0); |
---|
180 | if (len < 0) { |
---|
181 | wpa_printf(MSG_ERROR, "recv: %s", strerror(errno)); |
---|
182 | return; |
---|
183 | } |
---|
184 | |
---|
185 | /* must contain at least dhcp_message->chaddr */ |
---|
186 | if (len < 44) { |
---|
187 | wpa_printf(MSG_MSGDUMP, "handle_dhcp: too short (%d)", len); |
---|
188 | return; |
---|
189 | } |
---|
190 | |
---|
191 | msg = (struct dhcp_message *) buf; |
---|
192 | mac_address = (u8 *) &(msg->chaddr); |
---|
193 | |
---|
194 | wpa_printf(MSG_MSGDUMP, "Got DHCP broadcast packet from " MACSTR, |
---|
195 | MAC2STR(mac_address)); |
---|
196 | |
---|
197 | os_memset(&event, 0, sizeof(event)); |
---|
198 | event.new_sta.addr = mac_address; |
---|
199 | wpa_supplicant_event(eloop_ctx, EVENT_NEW_STA, &event); |
---|
200 | } |
---|
201 | #endif /* __linux__ */ |
---|
202 | |
---|
203 | |
---|
204 | static int wired_init_sockets(struct wpa_driver_wired_data *drv, u8 *own_addr) |
---|
205 | { |
---|
206 | #ifdef __linux__ |
---|
207 | struct ifreq ifr; |
---|
208 | struct sockaddr_ll addr; |
---|
209 | struct sockaddr_in addr2; |
---|
210 | int n = 1; |
---|
211 | |
---|
212 | drv->sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_PAE)); |
---|
213 | if (drv->sock < 0) { |
---|
214 | wpa_printf(MSG_ERROR, "socket[PF_PACKET,SOCK_RAW]: %s", |
---|
215 | strerror(errno)); |
---|
216 | return -1; |
---|
217 | } |
---|
218 | |
---|
219 | if (eloop_register_read_sock(drv->sock, handle_read, drv->ctx, NULL)) { |
---|
220 | wpa_printf(MSG_INFO, "Could not register read socket"); |
---|
221 | return -1; |
---|
222 | } |
---|
223 | |
---|
224 | os_memset(&ifr, 0, sizeof(ifr)); |
---|
225 | os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name)); |
---|
226 | if (ioctl(drv->sock, SIOCGIFINDEX, &ifr) != 0) { |
---|
227 | wpa_printf(MSG_ERROR, "ioctl(SIOCGIFINDEX): %s", |
---|
228 | strerror(errno)); |
---|
229 | return -1; |
---|
230 | } |
---|
231 | |
---|
232 | os_memset(&addr, 0, sizeof(addr)); |
---|
233 | addr.sll_family = AF_PACKET; |
---|
234 | addr.sll_ifindex = ifr.ifr_ifindex; |
---|
235 | wpa_printf(MSG_DEBUG, "Opening raw packet socket for ifindex %d", |
---|
236 | addr.sll_ifindex); |
---|
237 | |
---|
238 | if (bind(drv->sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) { |
---|
239 | wpa_printf(MSG_ERROR, "bind: %s", strerror(errno)); |
---|
240 | return -1; |
---|
241 | } |
---|
242 | |
---|
243 | /* filter multicast address */ |
---|
244 | if (wired_multicast_membership(drv->sock, ifr.ifr_ifindex, |
---|
245 | pae_group_addr, 1) < 0) { |
---|
246 | wpa_printf(MSG_ERROR, "wired: Failed to add multicast group " |
---|
247 | "membership"); |
---|
248 | return -1; |
---|
249 | } |
---|
250 | |
---|
251 | os_memset(&ifr, 0, sizeof(ifr)); |
---|
252 | os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name)); |
---|
253 | if (ioctl(drv->sock, SIOCGIFHWADDR, &ifr) != 0) { |
---|
254 | wpa_printf(MSG_ERROR, "ioctl(SIOCGIFHWADDR): %s", |
---|
255 | strerror(errno)); |
---|
256 | return -1; |
---|
257 | } |
---|
258 | |
---|
259 | if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) { |
---|
260 | wpa_printf(MSG_INFO, "Invalid HW-addr family 0x%04x", |
---|
261 | ifr.ifr_hwaddr.sa_family); |
---|
262 | return -1; |
---|
263 | } |
---|
264 | os_memcpy(own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN); |
---|
265 | |
---|
266 | /* setup dhcp listen socket for sta detection */ |
---|
267 | if ((drv->dhcp_sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) { |
---|
268 | wpa_printf(MSG_ERROR, "socket call failed for dhcp: %s", |
---|
269 | strerror(errno)); |
---|
270 | return -1; |
---|
271 | } |
---|
272 | |
---|
273 | if (eloop_register_read_sock(drv->dhcp_sock, handle_dhcp, drv->ctx, |
---|
274 | NULL)) { |
---|
275 | wpa_printf(MSG_INFO, "Could not register read socket"); |
---|
276 | return -1; |
---|
277 | } |
---|
278 | |
---|
279 | os_memset(&addr2, 0, sizeof(addr2)); |
---|
280 | addr2.sin_family = AF_INET; |
---|
281 | addr2.sin_port = htons(67); |
---|
282 | addr2.sin_addr.s_addr = INADDR_ANY; |
---|
283 | |
---|
284 | if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_REUSEADDR, (char *) &n, |
---|
285 | sizeof(n)) == -1) { |
---|
286 | wpa_printf(MSG_ERROR, "setsockopt[SOL_SOCKET,SO_REUSEADDR]: %s", |
---|
287 | strerror(errno)); |
---|
288 | return -1; |
---|
289 | } |
---|
290 | if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BROADCAST, (char *) &n, |
---|
291 | sizeof(n)) == -1) { |
---|
292 | wpa_printf(MSG_ERROR, "setsockopt[SOL_SOCKET,SO_BROADCAST]: %s", |
---|
293 | strerror(errno)); |
---|
294 | return -1; |
---|
295 | } |
---|
296 | |
---|
297 | os_memset(&ifr, 0, sizeof(ifr)); |
---|
298 | os_strlcpy(ifr.ifr_ifrn.ifrn_name, drv->ifname, IFNAMSIZ); |
---|
299 | if (setsockopt(drv->dhcp_sock, SOL_SOCKET, SO_BINDTODEVICE, |
---|
300 | (char *) &ifr, sizeof(ifr)) < 0) { |
---|
301 | wpa_printf(MSG_ERROR, |
---|
302 | "setsockopt[SOL_SOCKET,SO_BINDTODEVICE]: %s", |
---|
303 | strerror(errno)); |
---|
304 | return -1; |
---|
305 | } |
---|
306 | |
---|
307 | if (bind(drv->dhcp_sock, (struct sockaddr *) &addr2, |
---|
308 | sizeof(struct sockaddr)) == -1) { |
---|
309 | wpa_printf(MSG_ERROR, "bind: %s", strerror(errno)); |
---|
310 | return -1; |
---|
311 | } |
---|
312 | |
---|
313 | return 0; |
---|
314 | #else /* __linux__ */ |
---|
315 | return -1; |
---|
316 | #endif /* __linux__ */ |
---|
317 | } |
---|
318 | |
---|
319 | |
---|
320 | static int wired_send_eapol(void *priv, const u8 *addr, |
---|
321 | const u8 *data, size_t data_len, int encrypt, |
---|
322 | const u8 *own_addr, u32 flags) |
---|
323 | { |
---|
324 | struct wpa_driver_wired_data *drv = priv; |
---|
325 | struct ieee8023_hdr *hdr; |
---|
326 | size_t len; |
---|
327 | u8 *pos; |
---|
328 | int res; |
---|
329 | |
---|
330 | len = sizeof(*hdr) + data_len; |
---|
331 | hdr = os_zalloc(len); |
---|
332 | if (hdr == NULL) { |
---|
333 | wpa_printf(MSG_INFO, |
---|
334 | "malloc() failed for wired_send_eapol(len=%lu)", |
---|
335 | (unsigned long) len); |
---|
336 | return -1; |
---|
337 | } |
---|
338 | |
---|
339 | os_memcpy(hdr->dest, drv->use_pae_group_addr ? pae_group_addr : addr, |
---|
340 | ETH_ALEN); |
---|
341 | os_memcpy(hdr->src, own_addr, ETH_ALEN); |
---|
342 | hdr->ethertype = htons(ETH_P_PAE); |
---|
343 | |
---|
344 | pos = (u8 *) (hdr + 1); |
---|
345 | os_memcpy(pos, data, data_len); |
---|
346 | |
---|
347 | res = send(drv->sock, (u8 *) hdr, len, 0); |
---|
348 | os_free(hdr); |
---|
349 | |
---|
350 | if (res < 0) { |
---|
351 | wpa_printf(MSG_ERROR, |
---|
352 | "wired_send_eapol - packet len: %lu - failed: send: %s", |
---|
353 | (unsigned long) len, strerror(errno)); |
---|
354 | } |
---|
355 | |
---|
356 | return res; |
---|
357 | } |
---|
358 | |
---|
359 | |
---|
360 | static void * wired_driver_hapd_init(struct hostapd_data *hapd, |
---|
361 | struct wpa_init_params *params) |
---|
362 | { |
---|
363 | struct wpa_driver_wired_data *drv; |
---|
364 | |
---|
365 | drv = os_zalloc(sizeof(struct wpa_driver_wired_data)); |
---|
366 | if (drv == NULL) { |
---|
367 | wpa_printf(MSG_INFO, |
---|
368 | "Could not allocate memory for wired driver data"); |
---|
369 | return NULL; |
---|
370 | } |
---|
371 | |
---|
372 | drv->ctx = hapd; |
---|
373 | os_strlcpy(drv->ifname, params->ifname, sizeof(drv->ifname)); |
---|
374 | drv->use_pae_group_addr = params->use_pae_group_addr; |
---|
375 | |
---|
376 | if (wired_init_sockets(drv, params->own_addr)) { |
---|
377 | os_free(drv); |
---|
378 | return NULL; |
---|
379 | } |
---|
380 | |
---|
381 | return drv; |
---|
382 | } |
---|
383 | |
---|
384 | |
---|
385 | static void wired_driver_hapd_deinit(void *priv) |
---|
386 | { |
---|
387 | struct wpa_driver_wired_data *drv = priv; |
---|
388 | |
---|
389 | if (drv->sock >= 0) { |
---|
390 | eloop_unregister_read_sock(drv->sock); |
---|
391 | close(drv->sock); |
---|
392 | } |
---|
393 | |
---|
394 | if (drv->dhcp_sock >= 0) { |
---|
395 | eloop_unregister_read_sock(drv->dhcp_sock); |
---|
396 | close(drv->dhcp_sock); |
---|
397 | } |
---|
398 | |
---|
399 | os_free(drv); |
---|
400 | } |
---|
401 | |
---|
402 | |
---|
403 | static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid) |
---|
404 | { |
---|
405 | ssid[0] = 0; |
---|
406 | return 0; |
---|
407 | } |
---|
408 | |
---|
409 | |
---|
410 | static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid) |
---|
411 | { |
---|
412 | /* Report PAE group address as the "BSSID" for wired connection. */ |
---|
413 | os_memcpy(bssid, pae_group_addr, ETH_ALEN); |
---|
414 | return 0; |
---|
415 | } |
---|
416 | |
---|
417 | |
---|
418 | static int wpa_driver_wired_get_capa(void *priv, struct wpa_driver_capa *capa) |
---|
419 | { |
---|
420 | os_memset(capa, 0, sizeof(*capa)); |
---|
421 | capa->flags = WPA_DRIVER_FLAGS_WIRED; |
---|
422 | return 0; |
---|
423 | } |
---|
424 | |
---|
425 | |
---|
426 | static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags) |
---|
427 | { |
---|
428 | struct ifreq ifr; |
---|
429 | int s; |
---|
430 | |
---|
431 | s = socket(PF_INET, SOCK_DGRAM, 0); |
---|
432 | if (s < 0) { |
---|
433 | wpa_printf(MSG_ERROR, "socket: %s", strerror(errno)); |
---|
434 | return -1; |
---|
435 | } |
---|
436 | |
---|
437 | os_memset(&ifr, 0, sizeof(ifr)); |
---|
438 | os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ); |
---|
439 | if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) { |
---|
440 | wpa_printf(MSG_ERROR, "ioctl[SIOCGIFFLAGS]: %s", |
---|
441 | strerror(errno)); |
---|
442 | close(s); |
---|
443 | return -1; |
---|
444 | } |
---|
445 | close(s); |
---|
446 | *flags = ifr.ifr_flags & 0xffff; |
---|
447 | return 0; |
---|
448 | } |
---|
449 | |
---|
450 | |
---|
451 | static int wpa_driver_wired_set_ifflags(const char *ifname, int flags) |
---|
452 | { |
---|
453 | struct ifreq ifr; |
---|
454 | int s; |
---|
455 | |
---|
456 | s = socket(PF_INET, SOCK_DGRAM, 0); |
---|
457 | if (s < 0) { |
---|
458 | wpa_printf(MSG_ERROR, "socket: %s", strerror(errno)); |
---|
459 | return -1; |
---|
460 | } |
---|
461 | |
---|
462 | os_memset(&ifr, 0, sizeof(ifr)); |
---|
463 | os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ); |
---|
464 | ifr.ifr_flags = flags & 0xffff; |
---|
465 | if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) { |
---|
466 | wpa_printf(MSG_ERROR, "ioctl[SIOCSIFFLAGS]: %s", |
---|
467 | strerror(errno)); |
---|
468 | close(s); |
---|
469 | return -1; |
---|
470 | } |
---|
471 | close(s); |
---|
472 | return 0; |
---|
473 | } |
---|
474 | |
---|
475 | #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__) |
---|
476 | static int wpa_driver_wired_get_ifstatus(const char *ifname, int *status) |
---|
477 | { |
---|
478 | struct ifmediareq ifmr; |
---|
479 | int s; |
---|
480 | |
---|
481 | s = socket(PF_INET, SOCK_DGRAM, 0); |
---|
482 | if (s < 0) { |
---|
483 | wpa_printf(MSG_ERROR, "socket: %s", strerror(errno)); |
---|
484 | return -1; |
---|
485 | } |
---|
486 | |
---|
487 | os_memset(&ifmr, 0, sizeof(ifmr)); |
---|
488 | os_strlcpy(ifmr.ifm_name, ifname, IFNAMSIZ); |
---|
489 | if (ioctl(s, SIOCGIFMEDIA, (caddr_t) &ifmr) < 0) { |
---|
490 | wpa_printf(MSG_ERROR, "ioctl[SIOCGIFMEDIA]: %s", |
---|
491 | strerror(errno)); |
---|
492 | close(s); |
---|
493 | return -1; |
---|
494 | } |
---|
495 | close(s); |
---|
496 | *status = (ifmr.ifm_status & (IFM_ACTIVE | IFM_AVALID)) == |
---|
497 | (IFM_ACTIVE | IFM_AVALID); |
---|
498 | |
---|
499 | return 0; |
---|
500 | } |
---|
501 | #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */ |
---|
502 | |
---|
503 | |
---|
504 | static int wpa_driver_wired_multi(const char *ifname, const u8 *addr, int add) |
---|
505 | { |
---|
506 | struct ifreq ifr; |
---|
507 | int s; |
---|
508 | |
---|
509 | #ifdef __sun__ |
---|
510 | return -1; |
---|
511 | #endif /* __sun__ */ |
---|
512 | |
---|
513 | s = socket(PF_INET, SOCK_DGRAM, 0); |
---|
514 | if (s < 0) { |
---|
515 | wpa_printf(MSG_ERROR, "socket: %s", strerror(errno)); |
---|
516 | return -1; |
---|
517 | } |
---|
518 | |
---|
519 | os_memset(&ifr, 0, sizeof(ifr)); |
---|
520 | os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ); |
---|
521 | #ifdef __linux__ |
---|
522 | ifr.ifr_hwaddr.sa_family = AF_UNSPEC; |
---|
523 | os_memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN); |
---|
524 | #endif /* __linux__ */ |
---|
525 | #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__) |
---|
526 | { |
---|
527 | struct sockaddr_dl *dlp; |
---|
528 | dlp = (struct sockaddr_dl *) &ifr.ifr_addr; |
---|
529 | dlp->sdl_len = sizeof(struct sockaddr_dl); |
---|
530 | dlp->sdl_family = AF_LINK; |
---|
531 | dlp->sdl_index = 0; |
---|
532 | dlp->sdl_nlen = 0; |
---|
533 | dlp->sdl_alen = ETH_ALEN; |
---|
534 | dlp->sdl_slen = 0; |
---|
535 | os_memcpy(LLADDR(dlp), addr, ETH_ALEN); |
---|
536 | } |
---|
537 | #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */ |
---|
538 | #if defined(__NetBSD__) || defined(__OpenBSD__) || defined(__APPLE__) |
---|
539 | { |
---|
540 | struct sockaddr *sap; |
---|
541 | sap = (struct sockaddr *) &ifr.ifr_addr; |
---|
542 | sap->sa_len = sizeof(struct sockaddr); |
---|
543 | sap->sa_family = AF_UNSPEC; |
---|
544 | os_memcpy(sap->sa_data, addr, ETH_ALEN); |
---|
545 | } |
---|
546 | #endif /* defined(__NetBSD__) || defined(__OpenBSD__) || defined(__APPLE__) */ |
---|
547 | |
---|
548 | if (ioctl(s, add ? SIOCADDMULTI : SIOCDELMULTI, (caddr_t) &ifr) < 0) { |
---|
549 | wpa_printf(MSG_ERROR, "ioctl[SIOC{ADD/DEL}MULTI]: %s", |
---|
550 | strerror(errno)); |
---|
551 | close(s); |
---|
552 | return -1; |
---|
553 | } |
---|
554 | close(s); |
---|
555 | return 0; |
---|
556 | } |
---|
557 | |
---|
558 | |
---|
559 | static void * wpa_driver_wired_init(void *ctx, const char *ifname) |
---|
560 | { |
---|
561 | struct wpa_driver_wired_data *drv; |
---|
562 | int flags, status; |
---|
563 | |
---|
564 | drv = os_zalloc(sizeof(*drv)); |
---|
565 | if (drv == NULL) |
---|
566 | return NULL; |
---|
567 | os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname)); |
---|
568 | drv->ctx = ctx; |
---|
569 | |
---|
570 | #ifdef __linux__ |
---|
571 | drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0); |
---|
572 | if (drv->pf_sock < 0) |
---|
573 | wpa_printf(MSG_ERROR, "socket(PF_PACKET): %s", strerror(errno)); |
---|
574 | #else /* __linux__ */ |
---|
575 | drv->pf_sock = -1; |
---|
576 | #endif /* __linux__ */ |
---|
577 | |
---|
578 | if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 && |
---|
579 | !(flags & IFF_UP) && |
---|
580 | wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) { |
---|
581 | drv->iff_up = 1; |
---|
582 | } |
---|
583 | |
---|
584 | if (wired_multicast_membership(drv->pf_sock, |
---|
585 | if_nametoindex(drv->ifname), |
---|
586 | pae_group_addr, 1) == 0) { |
---|
587 | wpa_printf(MSG_DEBUG, "%s: Added multicast membership with " |
---|
588 | "packet socket", __func__); |
---|
589 | drv->membership = 1; |
---|
590 | } else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) { |
---|
591 | wpa_printf(MSG_DEBUG, "%s: Added multicast membership with " |
---|
592 | "SIOCADDMULTI", __func__); |
---|
593 | drv->multi = 1; |
---|
594 | } else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) { |
---|
595 | wpa_printf(MSG_INFO, "%s: Could not get interface " |
---|
596 | "flags", __func__); |
---|
597 | os_free(drv); |
---|
598 | return NULL; |
---|
599 | } else if (flags & IFF_ALLMULTI) { |
---|
600 | wpa_printf(MSG_DEBUG, "%s: Interface is already configured " |
---|
601 | "for multicast", __func__); |
---|
602 | } else if (wpa_driver_wired_set_ifflags(ifname, |
---|
603 | flags | IFF_ALLMULTI) < 0) { |
---|
604 | wpa_printf(MSG_INFO, "%s: Failed to enable allmulti", |
---|
605 | __func__); |
---|
606 | os_free(drv); |
---|
607 | return NULL; |
---|
608 | } else { |
---|
609 | wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode", |
---|
610 | __func__); |
---|
611 | drv->iff_allmulti = 1; |
---|
612 | } |
---|
613 | #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__) |
---|
614 | { |
---|
615 | int status; |
---|
616 | wpa_printf(MSG_DEBUG, "%s: waiting for link to become active", |
---|
617 | __func__); |
---|
618 | while (wpa_driver_wired_get_ifstatus(ifname, &status) == 0 && |
---|
619 | status == 0) |
---|
620 | sleep(1); |
---|
621 | } |
---|
622 | #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */ |
---|
623 | |
---|
624 | return drv; |
---|
625 | } |
---|
626 | |
---|
627 | |
---|
628 | static void wpa_driver_wired_deinit(void *priv) |
---|
629 | { |
---|
630 | struct wpa_driver_wired_data *drv = priv; |
---|
631 | int flags; |
---|
632 | |
---|
633 | if (drv->membership && |
---|
634 | wired_multicast_membership(drv->pf_sock, |
---|
635 | if_nametoindex(drv->ifname), |
---|
636 | pae_group_addr, 0) < 0) { |
---|
637 | wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast " |
---|
638 | "group (PACKET)", __func__); |
---|
639 | } |
---|
640 | |
---|
641 | if (drv->multi && |
---|
642 | wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) { |
---|
643 | wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast " |
---|
644 | "group (SIOCDELMULTI)", __func__); |
---|
645 | } |
---|
646 | |
---|
647 | if (drv->iff_allmulti && |
---|
648 | (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 || |
---|
649 | wpa_driver_wired_set_ifflags(drv->ifname, |
---|
650 | flags & ~IFF_ALLMULTI) < 0)) { |
---|
651 | wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode", |
---|
652 | __func__); |
---|
653 | } |
---|
654 | |
---|
655 | if (drv->iff_up && |
---|
656 | wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 && |
---|
657 | (flags & IFF_UP) && |
---|
658 | wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) { |
---|
659 | wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down", |
---|
660 | __func__); |
---|
661 | } |
---|
662 | |
---|
663 | if (drv->pf_sock != -1) |
---|
664 | close(drv->pf_sock); |
---|
665 | |
---|
666 | os_free(drv); |
---|
667 | } |
---|
668 | |
---|
669 | |
---|
670 | const struct wpa_driver_ops wpa_driver_wired_ops = { |
---|
671 | .name = "wired", |
---|
672 | .desc = "Wired Ethernet driver", |
---|
673 | .hapd_init = wired_driver_hapd_init, |
---|
674 | .hapd_deinit = wired_driver_hapd_deinit, |
---|
675 | .hapd_send_eapol = wired_send_eapol, |
---|
676 | .get_ssid = wpa_driver_wired_get_ssid, |
---|
677 | .get_bssid = wpa_driver_wired_get_bssid, |
---|
678 | .get_capa = wpa_driver_wired_get_capa, |
---|
679 | .init = wpa_driver_wired_init, |
---|
680 | .deinit = wpa_driver_wired_deinit, |
---|
681 | }; |
---|