]> git.ipfire.org Git - thirdparty/hostap.git/blob - src/drivers/driver_bsd.c
projects / thirdparty / hostap.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Add more WPA/IEEE 802.1X parameters into set_ieee8021x() driver op
[thirdparty/hostap.git] / src / drivers / driver_bsd.c
1 /*
2 * WPA Supplicant - driver interaction with BSD net80211 layer
3 * Copyright (c) 2004, Sam Leffler <sam@errno.com>
4 * Copyright (c) 2004, 2Wire, Inc
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * Alternatively, this software may be distributed under the terms of BSD
11 * license.
12 *
13 * See README and COPYING for more details.
14 */
15
16 #include "includes.h"
17 #include <sys/ioctl.h>
18
19 #include "common.h"
20 #include "driver.h"
21 #include "eloop.h"
22 #include "common/ieee802_11_defs.h"
23
24 #include <net/if.h>
25
26 #ifdef __NetBSD__
27 #include <net/if_ether.h>
28 #else
29 #include <net/ethernet.h>
30 #endif
31 #include <net/route.h>
32
33 #ifdef __DragonFly__
34 #include <netproto/802_11/ieee80211_ioctl.h>
35 #include <netproto/802_11/ieee80211_dragonfly.h>
36 #else /* __DragonFly__ */
37 #include <net80211/ieee80211.h>
38 #include <net80211/ieee80211_crypto.h>
39 #include <net80211/ieee80211_ioctl.h>
40 #endif /* __DragonFly__ */
41 #if __FreeBSD__
42 #include <net80211/ieee80211_freebsd.h>
43 #endif
44 #if __NetBSD__
45 #include <net80211/ieee80211_netbsd.h>
46 #endif
47
48 /* Generic functions for hostapd and wpa_supplicant */
49
50 static int
51 bsd_set80211var(int s, const char *ifname, int op, const void *arg, int arg_len)
52 {
53 struct ieee80211req ireq;
54
55 os_memset(&ireq, 0, sizeof(ireq));
56 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
57 ireq.i_type = op;
58 ireq.i_len = arg_len;
59 ireq.i_data = (void *) arg;
60
61 if (ioctl(s, SIOCS80211, &ireq) < 0) {
62 fprintf(stderr, "ioctl[SIOCS80211, op %u, len %u]: %s\n",
63 op, arg_len, strerror(errno));
64 return -1;
65 }
66 return 0;
67 }
68
69 static int
70 bsd_get80211var(int s, const char *ifname, int op, void *arg, int arg_len)
71 {
72 struct ieee80211req ireq;
73
74 os_memset(&ireq, 0, sizeof(ireq));
75 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
76 ireq.i_type = op;
77 ireq.i_len = arg_len;
78 ireq.i_data = arg;
79
80 if (ioctl(s, SIOCG80211, &ireq) < 0) {
81 fprintf(stderr, "ioctl[SIOCG80211, op %u, len %u]: %s\n",
82 op, arg_len, strerror(errno));
83 return -1;
84 }
85 return ireq.i_len;
86 }
87
88 static int
89 bsd_set80211param(int s, const char *ifname, int op, int arg)
90 {
91 struct ieee80211req ireq;
92
93 os_memset(&ireq, 0, sizeof(ireq));
94 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
95 ireq.i_type = op;
96 ireq.i_val = arg;
97
98 if (ioctl(s, SIOCS80211, &ireq) < 0) {
99 fprintf(stderr, "ioctl[SIOCS80211, op %u, arg 0x%x]: %s\n",
100 op, arg, strerror(errno));
101 return -1;
102 }
103 return 0;
104 }
105
106 static int
107 bsd_get_ssid(int s, const char *ifname, u8 *ssid)
108 {
109 #ifdef SIOCG80211NWID
110 struct ieee80211_nwid nwid;
111 struct ifreq ifr;
112
113 os_memset(&ifr, 0, sizeof(ifr));
114 os_strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
115 ifr.ifr_data = (void *)&nwid;
116 if (ioctl(s, SIOCG80211NWID, &ifr) < 0 ||
117 nwid.i_len > IEEE80211_NWID_LEN)
118 return -1;
119 os_memcpy(ssid, nwid.i_nwid, nwid.i_len);
120 return nwid.i_len;
121 #else
122 return bsd_get80211var(s, ifname, IEEE80211_IOC_SSID,
123 ssid, IEEE80211_NWID_LEN);
124 #endif
125 }
126
127 static int
128 bsd_set_ssid(int s, const char *ifname, const u8 *ssid, size_t ssid_len)
129 {
130 #ifdef SIOCS80211NWID
131 struct ieee80211_nwid nwid;
132 struct ifreq ifr;
133
134 os_memcpy(nwid.i_nwid, ssid, ssid_len);
135 nwid.i_len = ssid_len;
136 os_memset(&ifr, 0, sizeof(ifr));
137 os_strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
138 ifr.ifr_data = (void *)&nwid;
139 return ioctl(s, SIOCS80211NWID, &ifr);
140 #else
141 return bsd_set80211var(s, ifname, IEEE80211_IOC_SSID, ssid, ssid_len);
142 #endif
143 }
144
145
146 #ifdef HOSTAPD
147
148 /*
149 * Avoid conflicts with hostapd definitions by undefining couple of defines
150 * from net80211 header files.
151 */
152 #undef RSN_VERSION
153 #undef WPA_VERSION
154 #undef WPA_OUI_TYPE
155
156 #include "l2_packet/l2_packet.h"
157 #include "../../hostapd/sta_flags.h"
158
159 struct bsd_driver_data {
160 struct hostapd_data *hapd; /* back pointer */
161
162 char iface[IFNAMSIZ + 1];
163 struct l2_packet_data *sock_xmit; /* raw packet xmit socket */
164 int ioctl_sock; /* socket for ioctl() use */
165 int wext_sock; /* socket for wireless events */
166 };
167
168 static int bsd_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr,
169 int reason_code);
170
171 static int
172 set80211var(struct bsd_driver_data *drv, int op, const void *arg, int arg_len)
173 {
174 return bsd_set80211var(drv->ioctl_sock, drv->iface, op, arg, arg_len);
175 }
176
177 static int
178 get80211var(struct bsd_driver_data *drv, int op, void *arg, int arg_len)
179 {
180 return bsd_get80211var(drv->ioctl_sock, drv->iface, op, arg, arg_len);
181 }
182
183 static int
184 set80211param(struct bsd_driver_data *drv, int op, int arg)
185 {
186 return bsd_set80211param(drv->ioctl_sock, drv->iface, op, arg);
187 }
188
189 static const char *
190 ether_sprintf(const u8 *addr)
191 {
192 static char buf[sizeof(MACSTR)];
193
194 if (addr != NULL)
195 snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr));
196 else
197 snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0);
198 return buf;
199 }
200
201 /*
202 * Configure WPA parameters.
203 */
204 static int
205 bsd_configure_wpa(struct bsd_driver_data *drv, struct wpa_bss_params *params)
206 {
207 static const char *ciphernames[] =
208 { "WEP", "TKIP", "AES-OCB", "AES-CCM", "CKIP", "NONE" };
209 int v;
210
211 switch (params->wpa_group) {
212 case WPA_CIPHER_CCMP:
213 v = IEEE80211_CIPHER_AES_CCM;
214 break;
215 case WPA_CIPHER_TKIP:
216 v = IEEE80211_CIPHER_TKIP;
217 break;
218 case WPA_CIPHER_WEP104:
219 v = IEEE80211_CIPHER_WEP;
220 break;
221 case WPA_CIPHER_WEP40:
222 v = IEEE80211_CIPHER_WEP;
223 break;
224 case WPA_CIPHER_NONE:
225 v = IEEE80211_CIPHER_NONE;
226 break;
227 default:
228 printf("Unknown group key cipher %u\n",
229 params->wpa_group);
230 return -1;
231 }
232 wpa_printf(MSG_DEBUG, "%s: group key cipher=%s (%u)",
233 __func__, ciphernames[v], v);
234 if (set80211param(drv, IEEE80211_IOC_MCASTCIPHER, v)) {
235 printf("Unable to set group key cipher to %u (%s)\n",
236 v, ciphernames[v]);
237 return -1;
238 }
239 if (v == IEEE80211_CIPHER_WEP) {
240 /* key length is done only for specific ciphers */
241 v = (params->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5);
242 if (set80211param(drv, IEEE80211_IOC_MCASTKEYLEN, v)) {
243 printf("Unable to set group key length to %u\n", v);
244 return -1;
245 }
246 }
247
248 v = 0;
249 if (params->wpa_pairwise & WPA_CIPHER_CCMP)
250 v |= 1<<IEEE80211_CIPHER_AES_CCM;
251 if (params->wpa_pairwise & WPA_CIPHER_TKIP)
252 v |= 1<<IEEE80211_CIPHER_TKIP;
253 if (params->wpa_pairwise & WPA_CIPHER_NONE)
254 v |= 1<<IEEE80211_CIPHER_NONE;
255 wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v);
256 if (set80211param(drv, IEEE80211_IOC_UCASTCIPHERS, v)) {
257 printf("Unable to set pairwise key ciphers to 0x%x\n", v);
258 return -1;
259 }
260
261 wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x",
262 __func__, params->wpa_key_mgmt);
263 if (set80211param(drv, IEEE80211_IOC_KEYMGTALGS, params->wpa_key_mgmt))
264 {
265 printf("Unable to set key management algorithms to 0x%x\n",
266 params->wpa_key_mgmt);
267 return -1;
268 }
269
270 v = 0;
271 if (params->rsn_preauth)
272 v |= BIT(0);
273 wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x",
274 __func__, params->rsn_preauth);
275 if (set80211param(drv, IEEE80211_IOC_RSNCAPS, v)) {
276 printf("Unable to set RSN capabilities to 0x%x\n", v);
277 return -1;
278 }
279
280 wpa_printf(MSG_DEBUG, "%s: enable WPA= 0x%x", __func__, params->wpa);
281 if (set80211param(drv, IEEE80211_IOC_WPA, params->wpa)) {
282 printf("Unable to set WPA to %u\n", params->wpa);
283 return -1;
284 }
285 return 0;
286 }
287
288
289 static int
290 bsd_set_iface_flags(void *priv, int dev_up)
291 {
292 struct bsd_driver_data *drv = priv;
293 struct ifreq ifr;
294
295 wpa_printf(MSG_DEBUG, "%s: dev_up=%d", __func__, dev_up);
296
297 if (drv->ioctl_sock < 0)
298 return -1;
299
300 memset(&ifr, 0, sizeof(ifr));
301 os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name));
302
303 if (ioctl(drv->ioctl_sock, SIOCGIFFLAGS, &ifr) != 0) {
304 perror("ioctl[SIOCGIFFLAGS]");
305 return -1;
306 }
307
308 if (dev_up)
309 ifr.ifr_flags |= IFF_UP;
310 else
311 ifr.ifr_flags &= ~IFF_UP;
312
313 if (ioctl(drv->ioctl_sock, SIOCSIFFLAGS, &ifr) != 0) {
314 perror("ioctl[SIOCSIFFLAGS]");
315 return -1;
316 }
317
318 return 0;
319 }
320
321 static int
322 bsd_set_ieee8021x(void *priv, struct wpa_bss_params *params)
323 {
324 struct bsd_driver_data *drv = priv;
325
326 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled);
327
328 if (!params->enabled) {
329 /* XXX restore state */
330 return set80211param(priv, IEEE80211_IOC_AUTHMODE,
331 IEEE80211_AUTH_AUTO);
332 }
333 if (!params->wpa && !params->ieee802_1x) {
334 hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER,
335 HOSTAPD_LEVEL_WARNING, "No 802.1X or WPA enabled!");
336 return -1;
337 }
338 if (params->wpa && bsd_configure_wpa(drv) != 0) {
339 hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER,
340 HOSTAPD_LEVEL_WARNING, "Error configuring WPA state!");
341 return -1;
342 }
343 if (set80211param(priv, IEEE80211_IOC_AUTHMODE,
344 (params->wpa ? IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) {
345 hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER,
346 HOSTAPD_LEVEL_WARNING, "Error enabling WPA/802.1X!");
347 return -1;
348 }
349 return bsd_set_iface_flags(priv, 1);
350 }
351
352 static int
353 bsd_set_privacy(const char *ifname, void *priv, int enabled)
354 {
355 struct bsd_driver_data *drv = priv;
356
357 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
358
359 return set80211param(drv, IEEE80211_IOC_PRIVACY, enabled);
360 }
361
362 static int
363 bsd_set_sta_authorized(void *priv, const u8 *addr, int authorized)
364 {
365 struct bsd_driver_data *drv = priv;
366 struct ieee80211req_mlme mlme;
367
368 wpa_printf(MSG_DEBUG, "%s: addr=%s authorized=%d",
369 __func__, ether_sprintf(addr), authorized);
370
371 if (authorized)
372 mlme.im_op = IEEE80211_MLME_AUTHORIZE;
373 else
374 mlme.im_op = IEEE80211_MLME_UNAUTHORIZE;
375 mlme.im_reason = 0;
376 memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
377 return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
378 }
379
380 static int
381 bsd_sta_set_flags(void *priv, const u8 *addr, int total_flags, int flags_or,
382 int flags_and)
383 {
384 /* For now, only support setting Authorized flag */
385 if (flags_or & WLAN_STA_AUTHORIZED)
386 return bsd_set_sta_authorized(priv, addr, 1);
387 if (!(flags_and & WLAN_STA_AUTHORIZED))
388 return bsd_set_sta_authorized(priv, addr, 0);
389 return 0;
390 }
391
392 static int
393 bsd_del_key(void *priv, const u8 *addr, int key_idx)
394 {
395 struct bsd_driver_data *drv = priv;
396 struct ieee80211req_del_key wk;
397
398 wpa_printf(MSG_DEBUG, "%s: addr=%s key_idx=%d",
399 __func__, ether_sprintf(addr), key_idx);
400
401 memset(&wk, 0, sizeof(wk));
402 if (addr != NULL) {
403 memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN);
404 wk.idk_keyix = (u_int8_t) IEEE80211_KEYIX_NONE; /* XXX */
405 } else {
406 wk.idk_keyix = key_idx;
407 }
408
409 return set80211var(drv, IEEE80211_IOC_DELKEY, &wk, sizeof(wk));
410 }
411
412 static int
413 bsd_set_key(const char *ifname, void *priv, wpa_alg alg,
414 const u8 *addr, int key_idx, int set_tx, const u8 *seq,
415 size_t seq_len, const u8 *key, size_t key_len)
416 {
417 struct bsd_driver_data *drv = priv;
418 struct ieee80211req_key wk;
419 u_int8_t cipher;
420
421 if (alg == WPA_ALG_NONE)
422 return bsd_del_key(drv, addr, key_idx);
423
424 wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%s key_idx=%d",
425 __func__, alg, ether_sprintf(addr), key_idx);
426
427 if (alg == WPA_ALG_WEP)
428 cipher = IEEE80211_CIPHER_WEP;
429 else if (alg == WPA_ALG_TKIP)
430 cipher = IEEE80211_CIPHER_TKIP;
431 else if (alg == WPA_ALG_CCMP)
432 cipher = IEEE80211_CIPHER_AES_CCM;
433 else {
434 printf("%s: unknown/unsupported algorithm %d\n",
435 __func__, alg);
436 return -1;
437 }
438
439 if (key_len > sizeof(wk.ik_keydata)) {
440 printf("%s: key length %d too big\n", __func__, (int) key_len);
441 return -3;
442 }
443
444 memset(&wk, 0, sizeof(wk));
445 wk.ik_type = cipher;
446 wk.ik_flags = IEEE80211_KEY_RECV | IEEE80211_KEY_XMIT;
447 if (addr == NULL) {
448 memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
449 wk.ik_keyix = key_idx;
450 wk.ik_flags |= IEEE80211_KEY_DEFAULT;
451 } else {
452 memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
453 wk.ik_keyix = IEEE80211_KEYIX_NONE;
454 }
455 wk.ik_keylen = key_len;
456 memcpy(wk.ik_keydata, key, key_len);
457
458 return set80211var(drv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk));
459 }
460
461
462 static int
463 bsd_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx,
464 u8 *seq)
465 {
466 struct bsd_driver_data *drv = priv;
467 struct ieee80211req_key wk;
468
469 wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d",
470 __func__, ether_sprintf(addr), idx);
471
472 memset(&wk, 0, sizeof(wk));
473 if (addr == NULL)
474 memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
475 else
476 memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
477 wk.ik_keyix = idx;
478
479 if (get80211var(drv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk)) < 0) {
480 printf("Failed to get encryption.\n");
481 return -1;
482 }
483
484 #ifdef WORDS_BIGENDIAN
485 {
486 /*
487 * wk.ik_keytsc is in host byte order (big endian), need to
488 * swap it to match with the byte order used in WPA.
489 */
490 int i;
491 u8 tmp[WPA_KEY_RSC_LEN];
492 memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
493 for (i = 0; i < WPA_KEY_RSC_LEN; i++) {
494 seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1];
495 }
496 }
497 #else /* WORDS_BIGENDIAN */
498 memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
499 #endif /* WORDS_BIGENDIAN */
500 return 0;
501 }
502
503
504 static int
505 bsd_flush(void *priv)
506 {
507 u8 allsta[IEEE80211_ADDR_LEN];
508
509 memset(allsta, 0xff, IEEE80211_ADDR_LEN);
510 return bsd_sta_deauth(priv, NULL, allsta, IEEE80211_REASON_AUTH_LEAVE);
511 }
512
513
514 static int
515 bsd_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data,
516 const u8 *addr)
517 {
518 struct bsd_driver_data *drv = priv;
519 struct ieee80211req_sta_stats stats;
520
521 memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN);
522 if (get80211var(drv, IEEE80211_IOC_STA_STATS, &stats, sizeof(stats)) > 0) {
523 /* XXX? do packets counts include non-data frames? */
524 data->rx_packets = stats.is_stats.ns_rx_data;
525 data->rx_bytes = stats.is_stats.ns_rx_bytes;
526 data->tx_packets = stats.is_stats.ns_tx_data;
527 data->tx_bytes = stats.is_stats.ns_tx_bytes;
528 }
529 return 0;
530 }
531
532 static int
533 bsd_set_opt_ie(const char *ifname, void *priv, const u8 *ie, size_t ie_len)
534 {
535 /*
536 * Do nothing; we setup parameters at startup that define the
537 * contents of the beacon information element.
538 */
539 return 0;
540 }
541
542 static int
543 bsd_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, int reason_code)
544 {
545 struct bsd_driver_data *drv = priv;
546 struct ieee80211req_mlme mlme;
547
548 wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d",
549 __func__, ether_sprintf(addr), reason_code);
550
551 mlme.im_op = IEEE80211_MLME_DEAUTH;
552 mlme.im_reason = reason_code;
553 memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
554 return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
555 }
556
557 static int
558 bsd_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr,
559 int reason_code)
560 {
561 struct bsd_driver_data *drv = priv;
562 struct ieee80211req_mlme mlme;
563
564 wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d",
565 __func__, ether_sprintf(addr), reason_code);
566
567 mlme.im_op = IEEE80211_MLME_DISASSOC;
568 mlme.im_reason = reason_code;
569 memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
570 return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
571 }
572
573 static int
574 bsd_new_sta(struct bsd_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN])
575 {
576 struct hostapd_data *hapd = drv->hapd;
577 struct ieee80211req_wpaie ie;
578 int ielen = 0;
579 u8 *iebuf = NULL;
580
581 /*
582 * Fetch and validate any negotiated WPA/RSN parameters.
583 */
584 memset(&ie, 0, sizeof(ie));
585 memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN);
586 if (get80211var(drv, IEEE80211_IOC_WPAIE, &ie, sizeof(ie)) < 0) {
587 printf("Failed to get WPA/RSN information element.\n");
588 goto no_ie;
589 }
590 iebuf = ie.wpa_ie;
591 ielen = ie.wpa_ie[1];
592 if (ielen == 0)
593 iebuf = NULL;
594 else
595 ielen += 2;
596
597 no_ie:
598 return hostapd_notif_assoc(hapd, addr, iebuf, ielen);
599 }
600
601 static void
602 bsd_wireless_event_receive(int sock, void *ctx, void *sock_ctx)
603 {
604 struct bsd_driver_data *drv = ctx;
605 struct hostapd_data *hapd = drv->hapd;
606 char buf[2048];
607 struct if_announcemsghdr *ifan;
608 struct rt_msghdr *rtm;
609 struct ieee80211_michael_event *mic;
610 struct ieee80211_join_event *join;
611 struct ieee80211_leave_event *leave;
612 int n;
613
614 n = read(sock, buf, sizeof(buf));
615 if (n < 0) {
616 if (errno != EINTR && errno != EAGAIN)
617 perror("read(PF_ROUTE)");
618 return;
619 }
620
621 rtm = (struct rt_msghdr *) buf;
622 if (rtm->rtm_version != RTM_VERSION) {
623 wpa_printf(MSG_DEBUG, "Routing message version %d not "
624 "understood\n", rtm->rtm_version);
625 return;
626 }
627 ifan = (struct if_announcemsghdr *) rtm;
628 switch (rtm->rtm_type) {
629 case RTM_IEEE80211:
630 switch (ifan->ifan_what) {
631 case RTM_IEEE80211_ASSOC:
632 case RTM_IEEE80211_REASSOC:
633 case RTM_IEEE80211_DISASSOC:
634 case RTM_IEEE80211_SCAN:
635 break;
636 case RTM_IEEE80211_LEAVE:
637 leave = (struct ieee80211_leave_event *) &ifan[1];
638 hostapd_notif_disassoc(drv->hapd, leave->iev_addr);
639 break;
640 case RTM_IEEE80211_JOIN:
641 #ifdef RTM_IEEE80211_REJOIN
642 case RTM_IEEE80211_REJOIN:
643 #endif
644 join = (struct ieee80211_join_event *) &ifan[1];
645 bsd_new_sta(drv, join->iev_addr);
646 break;
647 case RTM_IEEE80211_REPLAY:
648 /* ignore */
649 break;
650 case RTM_IEEE80211_MICHAEL:
651 mic = (struct ieee80211_michael_event *) &ifan[1];
652 wpa_printf(MSG_DEBUG,
653 "Michael MIC failure wireless event: "
654 "keyix=%u src_addr=" MACSTR, mic->iev_keyix,
655 MAC2STR(mic->iev_src));
656 hostapd_michael_mic_failure(hapd, mic->iev_src);
657 break;
658 }
659 break;
660 }
661 }
662
663 static int
664 bsd_wireless_event_init(struct bsd_driver_data *drv)
665 {
666 int s;
667
668 drv->wext_sock = -1;
669
670 s = socket(PF_ROUTE, SOCK_RAW, 0);
671 if (s < 0) {
672 perror("socket(PF_ROUTE,SOCK_RAW)");
673 return -1;
674 }
675 eloop_register_read_sock(s, bsd_wireless_event_receive, drv, NULL);
676 drv->wext_sock = s;
677
678 return 0;
679 }
680
681 static void
682 bsd_wireless_event_deinit(struct bsd_driver_data *drv)
683 {
684 if (drv->wext_sock < 0)
685 return;
686 eloop_unregister_read_sock(drv->wext_sock);
687 close(drv->wext_sock);
688 }
689
690
691 static int
692 bsd_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len,
693 int encrypt, const u8 *own_addr)
694 {
695 struct bsd_driver_data *drv = priv;
696 unsigned char buf[3000];
697 unsigned char *bp = buf;
698 struct l2_ethhdr *eth;
699 size_t len;
700 int status;
701
702 /*
703 * Prepend the Etherent header. If the caller left us
704 * space at the front we could just insert it but since
705 * we don't know we copy to a local buffer. Given the frequency
706 * and size of frames this probably doesn't matter.
707 */
708 len = data_len + sizeof(struct l2_ethhdr);
709 if (len > sizeof(buf)) {
710 bp = malloc(len);
711 if (bp == NULL) {
712 printf("EAPOL frame discarded, cannot malloc temp "
713 "buffer of size %u!\n", (unsigned int) len);
714 return -1;
715 }
716 }
717 eth = (struct l2_ethhdr *) bp;
718 memcpy(eth->h_dest, addr, ETH_ALEN);
719 memcpy(eth->h_source, own_addr, ETH_ALEN);
720 eth->h_proto = htons(ETH_P_EAPOL);
721 memcpy(eth+1, data, data_len);
722
723 wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len);
724
725 status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len);
726
727 if (bp != buf)
728 free(bp);
729 return status;
730 }
731
732 static void
733 handle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
734 {
735 struct bsd_driver_data *drv = ctx;
736 hostapd_eapol_receive(drv->hapd, src_addr,
737 buf + sizeof(struct l2_ethhdr),
738 len - sizeof(struct l2_ethhdr));
739 }
740
741 static int
742 hostapd_bsd_get_ssid(const char *ifname, void *priv, u8 *buf, int len)
743 {
744 struct bsd_driver_data *drv = priv;
745 int ssid_len;
746
747 ssid_len = bsd_get_ssid(drv->ioctl_sock, drv->iface, buf);
748 wpa_printf(MSG_DEBUG, "%s: ssid=\"%.*s\"", __func__, ssid_len, buf);
749
750 return ssid_len;
751 }
752
753 static int
754 hostapd_bsd_set_ssid(const char *ifname, void *priv, const u8 *buf, int len)
755 {
756 struct bsd_driver_data *drv = priv;
757
758 wpa_printf(MSG_DEBUG, "%s: ssid=\"%.*s\"", __func__, len, buf);
759
760 return bsd_set_ssid(drv->ioctl_sock, drv->iface, buf, len);
761 }
762
763 static void *
764 bsd_init(struct hostapd_data *hapd, struct wpa_init_params *params)
765 {
766 struct bsd_driver_data *drv;
767
768 drv = os_zalloc(sizeof(struct bsd_driver_data));
769 if (drv == NULL) {
770 printf("Could not allocate memory for bsd driver data\n");
771 goto bad;
772 }
773
774 drv->hapd = hapd;
775 drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0);
776 if (drv->ioctl_sock < 0) {
777 perror("socket[PF_INET,SOCK_DGRAM]");
778 goto bad;
779 }
780 memcpy(drv->iface, params->ifname, sizeof(drv->iface));
781
782 drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL,
783 handle_read, drv, 1);
784 if (drv->sock_xmit == NULL)
785 goto bad;
786 if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr))
787 goto bad;
788
789 bsd_set_iface_flags(drv, 0); /* mark down during setup */
790 if (bsd_wireless_event_init(drv))
791 goto bad;
792
793 return drv;
794 bad:
795 if (drv->sock_xmit != NULL)
796 l2_packet_deinit(drv->sock_xmit);
797 if (drv->ioctl_sock >= 0)
798 close(drv->ioctl_sock);
799 if (drv != NULL)
800 free(drv);
801 return NULL;
802 }
803
804
805 static void
806 bsd_deinit(void *priv)
807 {
808 struct bsd_driver_data *drv = priv;
809
810 bsd_wireless_event_deinit(drv);
811 (void) bsd_set_iface_flags(drv, 0);
812 if (drv->ioctl_sock >= 0)
813 close(drv->ioctl_sock);
814 if (drv->sock_xmit != NULL)
815 l2_packet_deinit(drv->sock_xmit);
816 free(drv);
817 }
818
819 const struct wpa_driver_ops wpa_driver_bsd_ops = {
820 .name = "bsd",
821 .hapd_init = bsd_init,
822 .hapd_deinit = bsd_deinit,
823 .set_ieee8021x = bsd_set_ieee8021x,
824 .set_privacy = bsd_set_privacy,
825 .set_key = bsd_set_key,
826 .get_seqnum = bsd_get_seqnum,
827 .flush = bsd_flush,
828 .set_generic_elem = bsd_set_opt_ie,
829 .sta_set_flags = bsd_sta_set_flags,
830 .read_sta_data = bsd_read_sta_driver_data,
831 .hapd_send_eapol = bsd_send_eapol,
832 .sta_disassoc = bsd_sta_disassoc,
833 .sta_deauth = bsd_sta_deauth,
834 .hapd_set_ssid = hostapd_bsd_set_ssid,
835 .hapd_get_ssid = hostapd_bsd_get_ssid,
836 };
837
838 #else /* HOSTAPD */
839
840 struct wpa_driver_bsd_data {
841 int sock; /* open socket for 802.11 ioctls */
842 int route; /* routing socket for events */
843 char ifname[IFNAMSIZ+1]; /* interface name */
844 unsigned int ifindex; /* interface index */
845 void *ctx;
846 int prev_roaming; /* roaming state to restore on deinit */
847 int prev_privacy; /* privacy state to restore on deinit */
848 int prev_wpa; /* wpa state to restore on deinit */
849 };
850
851 static int
852 set80211var(struct wpa_driver_bsd_data *drv, int op, const void *arg, int arg_len)
853 {
854 return bsd_set80211var(drv->sock, drv->ifname, op, arg, arg_len);
855 }
856
857 static int
858 get80211var(struct wpa_driver_bsd_data *drv, int op, void *arg, int arg_len)
859 {
860 return bsd_get80211var(drv->sock, drv->ifname, op, arg, arg_len);
861 }
862
863 static int
864 set80211param(struct wpa_driver_bsd_data *drv, int op, int arg)
865 {
866 return bsd_set80211param(drv->sock, drv->ifname, op, arg);
867 }
868
869 static int
870 get80211param(struct wpa_driver_bsd_data *drv, int op)
871 {
872 struct ieee80211req ireq;
873
874 os_memset(&ireq, 0, sizeof(ireq));
875 os_strlcpy(ireq.i_name, drv->ifname, sizeof(ireq.i_name));
876 ireq.i_type = op;
877
878 if (ioctl(drv->sock, SIOCG80211, &ireq) < 0) {
879 fprintf(stderr, "ioctl[SIOCG80211, op %u]: %s\n",
880 op, strerror(errno));
881 return -1;
882 }
883 return ireq.i_val;
884 }
885
886 static int
887 getifflags(struct wpa_driver_bsd_data *drv, int *flags)
888 {
889 struct ifreq ifr;
890
891 os_memset(&ifr, 0, sizeof(ifr));
892 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
893 if (ioctl(drv->sock, SIOCGIFFLAGS, (caddr_t)&ifr) < 0) {
894 perror("SIOCGIFFLAGS");
895 return errno;
896 }
897 *flags = ifr.ifr_flags & 0xffff;
898 return 0;
899 }
900
901 static int
902 setifflags(struct wpa_driver_bsd_data *drv, int flags)
903 {
904 struct ifreq ifr;
905
906 os_memset(&ifr, 0, sizeof(ifr));
907 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
908 ifr.ifr_flags = flags & 0xffff;
909 if (ioctl(drv->sock, SIOCSIFFLAGS, (caddr_t)&ifr) < 0) {
910 perror("SIOCSIFFLAGS");
911 return errno;
912 }
913 return 0;
914 }
915
916 static int
917 wpa_driver_bsd_get_bssid(void *priv, u8 *bssid)
918 {
919 struct wpa_driver_bsd_data *drv = priv;
920 #ifdef SIOCG80211BSSID
921 struct ieee80211_bssid bs;
922
923 os_strncpy(bs.i_name, drv->ifname, sizeof(bs.i_name));
924 if (ioctl(drv->sock, SIOCG80211BSSID, &bs) < 0)
925 return -1;
926 os_memcpy(bssid, bs.i_bssid, sizeof(bs.i_bssid));
927 return 0;
928 #else
929 return get80211var(drv, IEEE80211_IOC_BSSID,
930 bssid, IEEE80211_ADDR_LEN) < 0 ? -1 : 0;
931 #endif
932 }
933
934 #if 0
935 static int
936 wpa_driver_bsd_set_bssid(void *priv, const char *bssid)
937 {
938 struct wpa_driver_bsd_data *drv = priv;
939
940 return set80211var(drv, IEEE80211_IOC_BSSID,
941 bssid, IEEE80211_ADDR_LEN);
942 }
943 #endif
944
945 static int
946 wpa_driver_bsd_get_ssid(void *priv, u8 *ssid)
947 {
948 struct wpa_driver_bsd_data *drv = priv;
949
950 return bsd_get_ssid(drv->sock, drv->ifname, ssid);
951 }
952
953 static int
954 wpa_driver_bsd_set_ssid(void *priv, const u8 *ssid,
955 size_t ssid_len)
956 {
957 struct wpa_driver_bsd_data *drv = priv;
958
959 return bsd_set_ssid(drv->sock, drv->ifname, ssid, ssid_len);
960 }
961
962 static int
963 wpa_driver_bsd_set_wpa_ie(struct wpa_driver_bsd_data *drv,
964 const u8 *wpa_ie, size_t wpa_ie_len)
965 {
966 return set80211var(drv, IEEE80211_IOC_OPTIE, wpa_ie, wpa_ie_len);
967 }
968
969 static int
970 wpa_driver_bsd_set_wpa_internal(void *priv, int wpa, int privacy)
971 {
972 struct wpa_driver_bsd_data *drv = priv;
973 int ret = 0;
974
975 wpa_printf(MSG_DEBUG, "%s: wpa=%d privacy=%d",
976 __FUNCTION__, wpa, privacy);
977
978 if (!wpa && wpa_driver_bsd_set_wpa_ie(drv, NULL, 0) < 0)
979 ret = -1;
980 if (set80211param(drv, IEEE80211_IOC_PRIVACY, privacy) < 0)
981 ret = -1;
982 if (set80211param(drv, IEEE80211_IOC_WPA, wpa) < 0)
983 ret = -1;
984
985 return ret;
986 }
987
988 static int
989 wpa_driver_bsd_set_wpa(void *priv, int enabled)
990 {
991 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled);
992
993 return wpa_driver_bsd_set_wpa_internal(priv, enabled ? 3 : 0, enabled);
994 }
995
996 static int
997 wpa_driver_bsd_del_key(struct wpa_driver_bsd_data *drv, int key_idx,
998 const unsigned char *addr)
999 {
1000 struct ieee80211req_del_key wk;
1001
1002 os_memset(&wk, 0, sizeof(wk));
1003 if (addr != NULL &&
1004 bcmp(addr, "\xff\xff\xff\xff\xff\xff", IEEE80211_ADDR_LEN) != 0) {
1005 struct ether_addr ea;
1006
1007 os_memcpy(&ea, addr, IEEE80211_ADDR_LEN);
1008 wpa_printf(MSG_DEBUG, "%s: addr=%s keyidx=%d",
1009 __func__, ether_ntoa(&ea), key_idx);
1010 os_memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN);
1011 wk.idk_keyix = (uint8_t) IEEE80211_KEYIX_NONE;
1012 } else {
1013 wpa_printf(MSG_DEBUG, "%s: keyidx=%d", __func__, key_idx);
1014 wk.idk_keyix = key_idx;
1015 }
1016 return set80211var(drv, IEEE80211_IOC_DELKEY, &wk, sizeof(wk));
1017 }
1018
1019 static int
1020 wpa_driver_bsd_set_key(const char *ifname, void *priv, wpa_alg alg,
1021 const unsigned char *addr, int key_idx, int set_tx,
1022 const u8 *seq, size_t seq_len,
1023 const u8 *key, size_t key_len)
1024 {
1025 struct wpa_driver_bsd_data *drv = priv;
1026 struct ieee80211req_key wk;
1027 struct ether_addr ea;
1028 char *alg_name;
1029 u_int8_t cipher;
1030
1031 if (alg == WPA_ALG_NONE)
1032 return wpa_driver_bsd_del_key(drv, key_idx, addr);
1033
1034 switch (alg) {
1035 case WPA_ALG_WEP:
1036 alg_name = "WEP";
1037 cipher = IEEE80211_CIPHER_WEP;
1038 break;
1039 case WPA_ALG_TKIP:
1040 alg_name = "TKIP";
1041 cipher = IEEE80211_CIPHER_TKIP;
1042 break;
1043 case WPA_ALG_CCMP:
1044 alg_name = "CCMP";
1045 cipher = IEEE80211_CIPHER_AES_CCM;
1046 break;
1047 default:
1048 wpa_printf(MSG_DEBUG, "%s: unknown/unsupported algorithm %d",
1049 __func__, alg);
1050 return -1;
1051 }
1052
1053 os_memcpy(&ea, addr, IEEE80211_ADDR_LEN);
1054 wpa_printf(MSG_DEBUG,
1055 "%s: alg=%s addr=%s key_idx=%d set_tx=%d seq_len=%zu key_len=%zu",
1056 __func__, alg_name, ether_ntoa(&ea), key_idx, set_tx,
1057 seq_len, key_len);
1058
1059 if (seq_len > sizeof(u_int64_t)) {
1060 wpa_printf(MSG_DEBUG, "%s: seq_len %zu too big",
1061 __func__, seq_len);
1062 return -2;
1063 }
1064 if (key_len > sizeof(wk.ik_keydata)) {
1065 wpa_printf(MSG_DEBUG, "%s: key length %zu too big",
1066 __func__, key_len);
1067 return -3;
1068 }
1069
1070 os_memset(&wk, 0, sizeof(wk));
1071 wk.ik_type = cipher;
1072 wk.ik_flags = IEEE80211_KEY_RECV;
1073 if (set_tx)
1074 wk.ik_flags |= IEEE80211_KEY_XMIT;
1075 os_memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
1076 /*
1077 * Deduce whether group/global or unicast key by checking
1078 * the address (yech). Note also that we can only mark global
1079 * keys default; doing this for a unicast key is an error.
1080 */
1081 if (bcmp(addr, "\xff\xff\xff\xff\xff\xff", IEEE80211_ADDR_LEN) == 0) {
1082 wk.ik_flags |= IEEE80211_KEY_GROUP;
1083 wk.ik_keyix = key_idx;
1084 } else {
1085 wk.ik_keyix = (key_idx == 0 ? IEEE80211_KEYIX_NONE : key_idx);
1086 }
1087 if (wk.ik_keyix != IEEE80211_KEYIX_NONE && set_tx)
1088 wk.ik_flags |= IEEE80211_KEY_DEFAULT;
1089 wk.ik_keylen = key_len;
1090 os_memcpy(&wk.ik_keyrsc, seq, seq_len);
1091 os_memcpy(wk.ik_keydata, key, key_len);
1092
1093 return set80211var(drv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk));
1094 }
1095
1096 static int
1097 wpa_driver_bsd_set_countermeasures(void *priv, int enabled)
1098 {
1099 struct wpa_driver_bsd_data *drv = priv;
1100
1101 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
1102 return set80211param(drv, IEEE80211_IOC_COUNTERMEASURES, enabled);
1103 }
1104
1105
1106 static int
1107 wpa_driver_bsd_set_drop_unencrypted(void *priv, int enabled)
1108 {
1109 struct wpa_driver_bsd_data *drv = priv;
1110
1111 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
1112 return set80211param(drv, IEEE80211_IOC_DROPUNENCRYPTED, enabled);
1113 }
1114
1115 static int
1116 wpa_driver_bsd_deauthenticate(void *priv, const u8 *addr, int reason_code)
1117 {
1118 struct wpa_driver_bsd_data *drv = priv;
1119 struct ieee80211req_mlme mlme;
1120
1121 wpa_printf(MSG_DEBUG, "%s", __func__);
1122 os_memset(&mlme, 0, sizeof(mlme));
1123 mlme.im_op = IEEE80211_MLME_DEAUTH;
1124 mlme.im_reason = reason_code;
1125 os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
1126 return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
1127 }
1128
1129 static int
1130 wpa_driver_bsd_disassociate(void *priv, const u8 *addr, int reason_code)
1131 {
1132 struct wpa_driver_bsd_data *drv = priv;
1133 struct ieee80211req_mlme mlme;
1134
1135 wpa_printf(MSG_DEBUG, "%s", __func__);
1136 os_memset(&mlme, 0, sizeof(mlme));
1137 mlme.im_op = IEEE80211_MLME_DISASSOC;
1138 mlme.im_reason = reason_code;
1139 os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
1140 return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
1141 }
1142
1143 static int
1144 wpa_driver_bsd_set_auth_alg(void *priv, int auth_alg)
1145 {
1146 struct wpa_driver_bsd_data *drv = priv;
1147 int authmode;
1148
1149 if ((auth_alg & AUTH_ALG_OPEN_SYSTEM) &&
1150 (auth_alg & AUTH_ALG_SHARED_KEY))
1151 authmode = IEEE80211_AUTH_AUTO;
1152 else if (auth_alg & AUTH_ALG_SHARED_KEY)
1153 authmode = IEEE80211_AUTH_SHARED;
1154 else
1155 authmode = IEEE80211_AUTH_OPEN;
1156
1157 return set80211param(drv, IEEE80211_IOC_AUTHMODE, authmode);
1158 }
1159
1160 static int
1161 wpa_driver_bsd_associate(void *priv, struct wpa_driver_associate_params *params)
1162 {
1163 struct wpa_driver_bsd_data *drv = priv;
1164 struct ieee80211req_mlme mlme;
1165 int privacy;
1166 int ret = 0;
1167
1168 wpa_printf(MSG_DEBUG,
1169 "%s: ssid '%.*s' wpa ie len %u pairwise %u group %u key mgmt %u"
1170 , __func__
1171 , (unsigned int) params->ssid_len, params->ssid
1172 , (unsigned int) params->wpa_ie_len
1173 , params->pairwise_suite
1174 , params->group_suite
1175 , params->key_mgmt_suite
1176 );
1177
1178 if (wpa_driver_bsd_set_drop_unencrypted(drv, params->drop_unencrypted)
1179 < 0)
1180 ret = -1;
1181 if (wpa_driver_bsd_set_auth_alg(drv, params->auth_alg) < 0)
1182 ret = -1;
1183 /* XXX error handling is wrong but unclear what to do... */
1184 if (wpa_driver_bsd_set_wpa_ie(drv, params->wpa_ie, params->wpa_ie_len) < 0)
1185 return -1;
1186
1187 privacy = !(params->pairwise_suite == CIPHER_NONE &&
1188 params->group_suite == CIPHER_NONE &&
1189 params->key_mgmt_suite == KEY_MGMT_NONE &&
1190 params->wpa_ie_len == 0);
1191 wpa_printf(MSG_DEBUG, "%s: set PRIVACY %u", __func__, privacy);
1192
1193 if (set80211param(drv, IEEE80211_IOC_PRIVACY, privacy) < 0)
1194 return -1;
1195
1196 if (params->wpa_ie_len &&
1197 set80211param(drv, IEEE80211_IOC_WPA,
1198 params->wpa_ie[0] == WLAN_EID_RSN ? 2 : 1) < 0)
1199 return -1;
1200
1201 os_memset(&mlme, 0, sizeof(mlme));
1202 mlme.im_op = IEEE80211_MLME_ASSOC;
1203 if (params->ssid != NULL)
1204 os_memcpy(mlme.im_ssid, params->ssid, params->ssid_len);
1205 mlme.im_ssid_len = params->ssid_len;
1206 if (params->bssid != NULL)
1207 os_memcpy(mlme.im_macaddr, params->bssid, IEEE80211_ADDR_LEN);
1208 if (set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme)) < 0)
1209 return -1;
1210 return ret;
1211 }
1212
1213 static int
1214 wpa_driver_bsd_scan(void *priv, struct wpa_driver_scan_params *params)
1215 {
1216 struct wpa_driver_bsd_data *drv = priv;
1217 int flags;
1218 const u8 *ssid = params->ssids[0].ssid;
1219 size_t ssid_len = params->ssids[0].ssid_len;
1220
1221 /* NB: interface must be marked UP to do a scan */
1222 if (getifflags(drv, &flags) != 0 || setifflags(drv, flags | IFF_UP) != 0)
1223 return -1;
1224
1225 /* set desired ssid before scan */
1226 if (wpa_driver_bsd_set_ssid(drv, ssid, ssid_len) < 0)
1227 return -1;
1228
1229 /* NB: net80211 delivers a scan complete event so no need to poll */
1230 return set80211param(drv, IEEE80211_IOC_SCAN_REQ, 0);
1231 }
1232
1233 static void
1234 wpa_driver_bsd_event_receive(int sock, void *ctx, void *sock_ctx)
1235 {
1236 struct wpa_driver_bsd_data *drv = sock_ctx;
1237 char buf[2048];
1238 struct if_announcemsghdr *ifan;
1239 struct if_msghdr *ifm;
1240 struct rt_msghdr *rtm;
1241 union wpa_event_data event;
1242 struct ieee80211_michael_event *mic;
1243 int n;
1244
1245 n = read(sock, buf, sizeof(buf));
1246 if (n < 0) {
1247 if (errno != EINTR && errno != EAGAIN)
1248 perror("read(PF_ROUTE)");
1249 return;
1250 }
1251
1252 rtm = (struct rt_msghdr *) buf;
1253 if (rtm->rtm_version != RTM_VERSION) {
1254 wpa_printf(MSG_DEBUG, "Routing message version %d not "
1255 "understood\n", rtm->rtm_version);
1256 return;
1257 }
1258 os_memset(&event, 0, sizeof(event));
1259 switch (rtm->rtm_type) {
1260 case RTM_IFANNOUNCE:
1261 ifan = (struct if_announcemsghdr *) rtm;
1262 if (ifan->ifan_index != drv->ifindex)
1263 break;
1264 strlcpy(event.interface_status.ifname, drv->ifname,
1265 sizeof(event.interface_status.ifname));
1266 switch (ifan->ifan_what) {
1267 case IFAN_DEPARTURE:
1268 event.interface_status.ievent = EVENT_INTERFACE_REMOVED;
1269 default:
1270 return;
1271 }
1272 wpa_printf(MSG_DEBUG, "RTM_IFANNOUNCE: Interface '%s' %s",
1273 event.interface_status.ifname,
1274 ifan->ifan_what == IFAN_DEPARTURE ?
1275 "removed" : "added");
1276 wpa_supplicant_event(ctx, EVENT_INTERFACE_STATUS, &event);
1277 break;
1278 case RTM_IEEE80211:
1279 ifan = (struct if_announcemsghdr *) rtm;
1280 if (ifan->ifan_index != drv->ifindex)
1281 break;
1282 switch (ifan->ifan_what) {
1283 case RTM_IEEE80211_ASSOC:
1284 case RTM_IEEE80211_REASSOC:
1285 wpa_supplicant_event(ctx, EVENT_ASSOC, NULL);
1286 break;
1287 case RTM_IEEE80211_DISASSOC:
1288 wpa_supplicant_event(ctx, EVENT_DISASSOC, NULL);
1289 break;
1290 case RTM_IEEE80211_SCAN:
1291 wpa_supplicant_event(ctx, EVENT_SCAN_RESULTS, NULL);
1292 break;
1293 case RTM_IEEE80211_REPLAY:
1294 /* ignore */
1295 break;
1296 case RTM_IEEE80211_MICHAEL:
1297 mic = (struct ieee80211_michael_event *) &ifan[1];
1298 wpa_printf(MSG_DEBUG,
1299 "Michael MIC failure wireless event: "
1300 "keyix=%u src_addr=" MACSTR, mic->iev_keyix,
1301 MAC2STR(mic->iev_src));
1302
1303 os_memset(&event, 0, sizeof(event));
1304 event.michael_mic_failure.unicast =
1305 !IEEE80211_IS_MULTICAST(mic->iev_dst);
1306 wpa_supplicant_event(ctx, EVENT_MICHAEL_MIC_FAILURE,
1307 &event);
1308 break;
1309 }
1310 break;
1311 case RTM_IFINFO:
1312 ifm = (struct if_msghdr *) rtm;
1313 if (ifm->ifm_index != drv->ifindex)
1314 break;
1315 if ((rtm->rtm_flags & RTF_UP) == 0) {
1316 strlcpy(event.interface_status.ifname, drv->ifname,
1317 sizeof(event.interface_status.ifname));
1318 event.interface_status.ievent = EVENT_INTERFACE_REMOVED;
1319 wpa_printf(MSG_DEBUG, "RTM_IFINFO: Interface '%s' DOWN",
1320 event.interface_status.ifname);
1321 wpa_supplicant_event(ctx, EVENT_INTERFACE_STATUS, &event);
1322 }
1323 break;
1324 }
1325 }
1326
1327 static void
1328 wpa_driver_bsd_add_scan_entry(struct wpa_scan_results *res,
1329 struct ieee80211req_scan_result *sr)
1330 {
1331 struct wpa_scan_res *result, **tmp;
1332 size_t extra_len;
1333 u8 *pos;
1334
1335 extra_len = 2 + sr->isr_ssid_len;
1336 extra_len += 2 + sr->isr_nrates;
1337 extra_len += 3; /* ERP IE */
1338 extra_len += sr->isr_ie_len;
1339
1340 result = os_zalloc(sizeof(*result) + extra_len);
1341 if (result == NULL)
1342 return;
1343 os_memcpy(result->bssid, sr->isr_bssid, ETH_ALEN);
1344 result->freq = sr->isr_freq;
1345 result->beacon_int = sr->isr_intval;
1346 result->caps = sr->isr_capinfo;
1347 result->qual = sr->isr_rssi;
1348 result->noise = sr->isr_noise;
1349
1350 pos = (u8 *)(result + 1);
1351
1352 *pos++ = WLAN_EID_SSID;
1353 *pos++ = sr->isr_ssid_len;
1354 os_memcpy(pos, sr + 1, sr->isr_ssid_len);
1355 pos += sr->isr_ssid_len;
1356
1357 /*
1358 * Deal all rates as supported rate.
1359 * Because net80211 doesn't report extended supported rate or not.
1360 */
1361 *pos++ = WLAN_EID_SUPP_RATES;
1362 *pos++ = sr->isr_nrates;
1363 os_memcpy(pos, sr->isr_rates, sr->isr_nrates);
1364 pos += sr->isr_nrates;
1365
1366 *pos++ = WLAN_EID_ERP_INFO;
1367 *pos++ = 1;
1368 *pos++ = sr->isr_erp;
1369
1370 os_memcpy(pos, (u8 *)(sr + 1) + sr->isr_ssid_len, sr->isr_ie_len);
1371 pos += sr->isr_ie_len;
1372
1373 result->ie_len = pos - (u8 *)(result + 1);
1374
1375 tmp = os_realloc(res->res,
1376 (res->num + 1) * sizeof(struct wpa_scan_res *));
1377 if (tmp == NULL) {
1378 os_free(result);
1379 return;
1380 }
1381 tmp[res->num++] = result;
1382 res->res = tmp;
1383 }
1384
1385 struct wpa_scan_results *
1386 wpa_driver_bsd_get_scan_results2(void *priv)
1387 {
1388 struct wpa_driver_bsd_data *drv = priv;
1389 struct ieee80211req_scan_result *sr;
1390 struct wpa_scan_results *res;
1391 int len, rest;
1392 uint8_t buf[24*1024], *pos;
1393
1394 len = get80211var(drv, IEEE80211_IOC_SCAN_RESULTS, buf, 24*1024);
1395 if (len < 0)
1396 return NULL;
1397
1398 res = os_zalloc(sizeof(*res));
1399 if (res == NULL)
1400 return NULL;
1401
1402 pos = buf;
1403 rest = len;
1404 while (rest >= sizeof(struct ieee80211req_scan_result)) {
1405 sr = (struct ieee80211req_scan_result *)pos;
1406 wpa_driver_bsd_add_scan_entry(res, sr);
1407 pos += sr->isr_len;
1408 rest -= sr->isr_len;
1409 }
1410
1411 wpa_printf(MSG_DEBUG, "Received %d bytes of scan results (%lu BSSes)",
1412 len, (unsigned long)res->num);
1413
1414 return res;
1415 }
1416
1417 static void *
1418 wpa_driver_bsd_init(void *ctx, const char *ifname)
1419 {
1420 #define GETPARAM(drv, param, v) \
1421 (((v) = get80211param(drv, param)) != -1)
1422 struct wpa_driver_bsd_data *drv;
1423
1424 drv = os_zalloc(sizeof(*drv));
1425 if (drv == NULL)
1426 return NULL;
1427 /*
1428 * NB: We require the interface name be mappable to an index.
1429 * This implies we do not support having wpa_supplicant
1430 * wait for an interface to appear. This seems ok; that
1431 * doesn't belong here; it's really the job of devd.
1432 */
1433 drv->ifindex = if_nametoindex(ifname);
1434 if (drv->ifindex == 0) {
1435 wpa_printf(MSG_DEBUG, "%s: interface %s does not exist",
1436 __func__, ifname);
1437 goto fail1;
1438 }
1439 drv->sock = socket(PF_INET, SOCK_DGRAM, 0);
1440 if (drv->sock < 0)
1441 goto fail1;
1442 drv->route = socket(PF_ROUTE, SOCK_RAW, 0);
1443 if (drv->route < 0)
1444 goto fail;
1445 eloop_register_read_sock(drv->route,
1446 wpa_driver_bsd_event_receive, ctx, drv);
1447
1448 drv->ctx = ctx;
1449 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
1450
1451 if (!GETPARAM(drv, IEEE80211_IOC_ROAMING, drv->prev_roaming)) {
1452 wpa_printf(MSG_DEBUG, "%s: failed to get roaming state: %s",
1453 __func__, strerror(errno));
1454 goto fail;
1455 }
1456 if (!GETPARAM(drv, IEEE80211_IOC_PRIVACY, drv->prev_privacy)) {
1457 wpa_printf(MSG_DEBUG, "%s: failed to get privacy state: %s",
1458 __func__, strerror(errno));
1459 goto fail;
1460 }
1461 if (!GETPARAM(drv, IEEE80211_IOC_WPA, drv->prev_wpa)) {
1462 wpa_printf(MSG_DEBUG, "%s: failed to get wpa state: %s",
1463 __func__, strerror(errno));
1464 goto fail;
1465 }
1466 if (set80211param(drv, IEEE80211_IOC_ROAMING, IEEE80211_ROAMING_MANUAL) < 0) {
1467 wpa_printf(MSG_DEBUG, "%s: failed to set wpa_supplicant-based "
1468 "roaming: %s", __func__, strerror(errno));
1469 goto fail;
1470 }
1471
1472 if (set80211param(drv, IEEE80211_IOC_WPA, 1+2) < 0) {
1473 wpa_printf(MSG_DEBUG, "%s: failed to enable WPA support %s",
1474 __func__, strerror(errno));
1475 goto fail;
1476 }
1477
1478 wpa_driver_bsd_set_wpa(drv, 1);
1479
1480 return drv;
1481 fail:
1482 close(drv->sock);
1483 fail1:
1484 os_free(drv);
1485 return NULL;
1486 #undef GETPARAM
1487 }
1488
1489 static void
1490 wpa_driver_bsd_deinit(void *priv)
1491 {
1492 struct wpa_driver_bsd_data *drv = priv;
1493 int flags;
1494
1495 wpa_driver_bsd_set_wpa(drv, 0);
1496 eloop_unregister_read_sock(drv->route);
1497
1498 /* NB: mark interface down */
1499 if (getifflags(drv, &flags) == 0)
1500 (void) setifflags(drv, flags &~ IFF_UP);
1501
1502 wpa_driver_bsd_set_wpa_internal(drv, drv->prev_wpa, drv->prev_privacy);
1503 if (set80211param(drv, IEEE80211_IOC_ROAMING, drv->prev_roaming) < 0)
1504 wpa_printf(MSG_DEBUG, "%s: failed to restore roaming state",
1505 __func__);
1506
1507 (void) close(drv->route); /* ioctl socket */
1508 (void) close(drv->sock); /* event socket */
1509 os_free(drv);
1510 }
1511
1512
1513 const struct wpa_driver_ops wpa_driver_bsd_ops = {
1514 .name = "bsd",
1515 .desc = "BSD 802.11 support",
1516 .init = wpa_driver_bsd_init,
1517 .deinit = wpa_driver_bsd_deinit,
1518 .get_bssid = wpa_driver_bsd_get_bssid,
1519 .get_ssid = wpa_driver_bsd_get_ssid,
1520 .set_key = wpa_driver_bsd_set_key,
1521 .set_countermeasures = wpa_driver_bsd_set_countermeasures,
1522 .scan2 = wpa_driver_bsd_scan,
1523 .get_scan_results2 = wpa_driver_bsd_get_scan_results2,
1524 .deauthenticate = wpa_driver_bsd_deauthenticate,
1525 .disassociate = wpa_driver_bsd_disassociate,
1526 .associate = wpa_driver_bsd_associate,
1527 };
1528
1529 #endif /* HOSTAPD */
Unnamed repository; edit this file 'description' to name the repository.