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