2 * WPA Supplicant - driver interaction with BSD net80211 layer
3 * Copyright (c) 2004, Sam Leffler <sam@errno.com>
4 * Copyright (c) 2004, 2Wire, Inc
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.
10 * Alternatively, this software may be distributed under the terms of BSD
13 * See README and COPYING for more details.
17 #include <sys/ioctl.h>
22 #include "ieee802_11_defs.h"
27 #include <net/if_ether.h>
29 #include <net/ethernet.h>
31 #include <net/route.h>
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__ */
42 #include <net80211/ieee80211_freebsd.h>
45 #include <net80211/ieee80211_netbsd.h>
48 /* Generic functions for hostapd and wpa_supplicant */
51 bsd_set80211var(int s
, const char *ifname
, int op
, const void *arg
, int arg_len
)
53 struct ieee80211req ireq
;
55 os_memset(&ireq
, 0, sizeof(ireq
));
56 os_strlcpy(ireq
.i_name
, ifname
, sizeof(ireq
.i_name
));
59 ireq
.i_data
= (void *) arg
;
61 if (ioctl(s
, SIOCS80211
, &ireq
) < 0) {
62 fprintf(stderr
, "ioctl[SIOCS80211, op %u, len %u]: %s\n",
63 op
, arg_len
, strerror(errno
));
70 bsd_get80211var(int s
, const char *ifname
, int op
, void *arg
, int arg_len
)
72 struct ieee80211req ireq
;
74 os_memset(&ireq
, 0, sizeof(ireq
));
75 os_strlcpy(ireq
.i_name
, ifname
, sizeof(ireq
.i_name
));
80 if (ioctl(s
, SIOCG80211
, &ireq
) < 0) {
81 fprintf(stderr
, "ioctl[SIOCG80211, op %u, len %u]: %s\n",
82 op
, arg_len
, strerror(errno
));
89 bsd_set80211param(int s
, const char *ifname
, int op
, int arg
)
91 struct ieee80211req ireq
;
93 os_memset(&ireq
, 0, sizeof(ireq
));
94 os_strlcpy(ireq
.i_name
, ifname
, sizeof(ireq
.i_name
));
98 if (ioctl(s
, SIOCS80211
, &ireq
) < 0) {
99 fprintf(stderr
, "ioctl[SIOCS80211, op %u, arg 0x%x]: %s\n",
100 op
, arg
, strerror(errno
));
107 bsd_get_ssid(int s
, const char *ifname
, u8
*ssid
)
109 #ifdef SIOCG80211NWID
110 struct ieee80211_nwid nwid
;
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
)
119 os_memcpy(ssid
, nwid
.i_nwid
, nwid
.i_len
);
122 return bsd_get80211var(s
, ifname
, IEEE80211_IOC_SSID
,
123 ssid
, IEEE80211_NWID_LEN
);
128 bsd_set_ssid(int s
, const char *ifname
, const u8
*ssid
, size_t ssid_len
)
130 #ifdef SIOCS80211NWID
131 struct ieee80211_nwid nwid
;
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
);
141 return bsd_set80211var(s
, ifname
, IEEE80211_IOC_SSID
, ssid
, ssid_len
);
149 * Avoid conflicts with hostapd definitions by undefining couple of defines
150 * from net80211 header files.
156 #include "l2_packet/l2_packet.h"
157 #include "../../hostapd/hostapd.h"
158 #include "../../hostapd/config.h"
159 #include "../../hostapd/eapol_sm.h"
160 #include "../../hostapd/sta_flags.h"
162 struct bsd_driver_data
{
163 struct hostapd_data
*hapd
; /* back pointer */
165 char iface
[IFNAMSIZ
+ 1];
166 struct l2_packet_data
*sock_xmit
; /* raw packet xmit socket */
167 int ioctl_sock
; /* socket for ioctl() use */
168 int wext_sock
; /* socket for wireless events */
171 static int bsd_sta_deauth(void *priv
, const u8
*own_addr
, const u8
*addr
,
175 set80211var(struct bsd_driver_data
*drv
, int op
, const void *arg
, int arg_len
)
177 return bsd_set80211var(drv
->ioctl_sock
, drv
->iface
, op
, arg
, arg_len
);
181 get80211var(struct bsd_driver_data
*drv
, int op
, void *arg
, int arg_len
)
183 return bsd_get80211var(drv
->ioctl_sock
, drv
->iface
, op
, arg
, arg_len
);
187 set80211param(struct bsd_driver_data
*drv
, int op
, int arg
)
189 return bsd_set80211param(drv
->ioctl_sock
, drv
->iface
, op
, arg
);
193 ether_sprintf(const u8
*addr
)
195 static char buf
[sizeof(MACSTR
)];
198 snprintf(buf
, sizeof(buf
), MACSTR
, MAC2STR(addr
));
200 snprintf(buf
, sizeof(buf
), MACSTR
, 0,0,0,0,0,0);
205 * Configure WPA parameters.
208 bsd_configure_wpa(struct bsd_driver_data
*drv
)
210 static const char *ciphernames
[] =
211 { "WEP", "TKIP", "AES-OCB", "AES-CCM", "CKIP", "NONE" };
212 struct hostapd_data
*hapd
= drv
->hapd
;
213 struct hostapd_bss_config
*conf
= hapd
->conf
;
216 switch (conf
->wpa_group
) {
217 case WPA_CIPHER_CCMP
:
218 v
= IEEE80211_CIPHER_AES_CCM
;
220 case WPA_CIPHER_TKIP
:
221 v
= IEEE80211_CIPHER_TKIP
;
223 case WPA_CIPHER_WEP104
:
224 v
= IEEE80211_CIPHER_WEP
;
226 case WPA_CIPHER_WEP40
:
227 v
= IEEE80211_CIPHER_WEP
;
229 case WPA_CIPHER_NONE
:
230 v
= IEEE80211_CIPHER_NONE
;
233 printf("Unknown group key cipher %u\n",
237 wpa_printf(MSG_DEBUG
, "%s: group key cipher=%s (%u)",
238 __func__
, ciphernames
[v
], v
);
239 if (set80211param(drv
, IEEE80211_IOC_MCASTCIPHER
, v
)) {
240 printf("Unable to set group key cipher to %u (%s)\n",
244 if (v
== IEEE80211_CIPHER_WEP
) {
245 /* key length is done only for specific ciphers */
246 v
= (conf
->wpa_group
== WPA_CIPHER_WEP104
? 13 : 5);
247 if (set80211param(drv
, IEEE80211_IOC_MCASTKEYLEN
, v
)) {
248 printf("Unable to set group key length to %u\n", v
);
254 if (conf
->wpa_pairwise
& WPA_CIPHER_CCMP
)
255 v
|= 1<<IEEE80211_CIPHER_AES_CCM
;
256 if (conf
->wpa_pairwise
& WPA_CIPHER_TKIP
)
257 v
|= 1<<IEEE80211_CIPHER_TKIP
;
258 if (conf
->wpa_pairwise
& WPA_CIPHER_NONE
)
259 v
|= 1<<IEEE80211_CIPHER_NONE
;
260 wpa_printf(MSG_DEBUG
, "%s: pairwise key ciphers=0x%x", __func__
, v
);
261 if (set80211param(drv
, IEEE80211_IOC_UCASTCIPHERS
, v
)) {
262 printf("Unable to set pairwise key ciphers to 0x%x\n", v
);
266 wpa_printf(MSG_DEBUG
, "%s: key management algorithms=0x%x",
267 __func__
, conf
->wpa_key_mgmt
);
268 if (set80211param(drv
, IEEE80211_IOC_KEYMGTALGS
, conf
->wpa_key_mgmt
)) {
269 printf("Unable to set key management algorithms to 0x%x\n",
275 if (conf
->rsn_preauth
)
277 wpa_printf(MSG_DEBUG
, "%s: rsn capabilities=0x%x",
278 __func__
, conf
->rsn_preauth
);
279 if (set80211param(drv
, IEEE80211_IOC_RSNCAPS
, v
)) {
280 printf("Unable to set RSN capabilities to 0x%x\n", v
);
284 wpa_printf(MSG_DEBUG
, "%s: enable WPA= 0x%x", __func__
, conf
->wpa
);
285 if (set80211param(drv
, IEEE80211_IOC_WPA
, conf
->wpa
)) {
286 printf("Unable to set WPA to %u\n", conf
->wpa
);
294 bsd_set_iface_flags(void *priv
, int dev_up
)
296 struct bsd_driver_data
*drv
= priv
;
299 wpa_printf(MSG_DEBUG
, "%s: dev_up=%d", __func__
, dev_up
);
301 if (drv
->ioctl_sock
< 0)
304 memset(&ifr
, 0, sizeof(ifr
));
305 os_strlcpy(ifr
.ifr_name
, drv
->iface
, sizeof(ifr
.ifr_name
));
307 if (ioctl(drv
->ioctl_sock
, SIOCGIFFLAGS
, &ifr
) != 0) {
308 perror("ioctl[SIOCGIFFLAGS]");
313 ifr
.ifr_flags
|= IFF_UP
;
315 ifr
.ifr_flags
&= ~IFF_UP
;
317 if (ioctl(drv
->ioctl_sock
, SIOCSIFFLAGS
, &ifr
) != 0) {
318 perror("ioctl[SIOCSIFFLAGS]");
326 bsd_set_ieee8021x(const char *ifname
, void *priv
, int enabled
)
328 struct bsd_driver_data
*drv
= priv
;
329 struct hostapd_data
*hapd
= drv
->hapd
;
330 struct hostapd_bss_config
*conf
= hapd
->conf
;
332 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
335 /* XXX restore state */
336 return set80211param(priv
, IEEE80211_IOC_AUTHMODE
,
337 IEEE80211_AUTH_AUTO
);
339 if (!conf
->wpa
&& !conf
->ieee802_1x
) {
340 hostapd_logger(hapd
, NULL
, HOSTAPD_MODULE_DRIVER
,
341 HOSTAPD_LEVEL_WARNING
, "No 802.1X or WPA enabled!");
344 if (conf
->wpa
&& bsd_configure_wpa(drv
) != 0) {
345 hostapd_logger(hapd
, NULL
, HOSTAPD_MODULE_DRIVER
,
346 HOSTAPD_LEVEL_WARNING
, "Error configuring WPA state!");
349 if (set80211param(priv
, IEEE80211_IOC_AUTHMODE
,
350 (conf
->wpa
? IEEE80211_AUTH_WPA
: IEEE80211_AUTH_8021X
))) {
351 hostapd_logger(hapd
, NULL
, HOSTAPD_MODULE_DRIVER
,
352 HOSTAPD_LEVEL_WARNING
, "Error enabling WPA/802.1X!");
355 return bsd_set_iface_flags(priv
, 1);
359 bsd_set_privacy(const char *ifname
, void *priv
, int enabled
)
361 struct bsd_driver_data
*drv
= priv
;
363 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
365 return set80211param(drv
, IEEE80211_IOC_PRIVACY
, enabled
);
369 bsd_set_sta_authorized(void *priv
, const u8
*addr
, int authorized
)
371 struct bsd_driver_data
*drv
= priv
;
372 struct ieee80211req_mlme mlme
;
374 wpa_printf(MSG_DEBUG
, "%s: addr=%s authorized=%d",
375 __func__
, ether_sprintf(addr
), authorized
);
378 mlme
.im_op
= IEEE80211_MLME_AUTHORIZE
;
380 mlme
.im_op
= IEEE80211_MLME_UNAUTHORIZE
;
382 memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
383 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
387 bsd_sta_set_flags(void *priv
, const u8
*addr
, int total_flags
, int flags_or
,
390 /* For now, only support setting Authorized flag */
391 if (flags_or
& WLAN_STA_AUTHORIZED
)
392 return bsd_set_sta_authorized(priv
, addr
, 1);
393 if (!(flags_and
& WLAN_STA_AUTHORIZED
))
394 return bsd_set_sta_authorized(priv
, addr
, 0);
399 bsd_del_key(void *priv
, const u8
*addr
, int key_idx
)
401 struct bsd_driver_data
*drv
= priv
;
402 struct ieee80211req_del_key wk
;
404 wpa_printf(MSG_DEBUG
, "%s: addr=%s key_idx=%d",
405 __func__
, ether_sprintf(addr
), key_idx
);
407 memset(&wk
, 0, sizeof(wk
));
409 memcpy(wk
.idk_macaddr
, addr
, IEEE80211_ADDR_LEN
);
410 wk
.idk_keyix
= (u_int8_t
) IEEE80211_KEYIX_NONE
; /* XXX */
412 wk
.idk_keyix
= key_idx
;
415 return set80211var(drv
, IEEE80211_IOC_DELKEY
, &wk
, sizeof(wk
));
419 bsd_set_key(const char *ifname
, void *priv
, wpa_alg alg
,
420 const u8
*addr
, int key_idx
, int set_tx
, const u8
*seq
,
421 size_t seq_len
, const u8
*key
, size_t key_len
)
423 struct bsd_driver_data
*drv
= priv
;
424 struct ieee80211req_key wk
;
427 if (alg
== WPA_ALG_NONE
)
428 return bsd_del_key(drv
, addr
, key_idx
);
430 wpa_printf(MSG_DEBUG
, "%s: alg=%d addr=%s key_idx=%d",
431 __func__
, alg
, ether_sprintf(addr
), key_idx
);
433 if (alg
== WPA_ALG_WEP
)
434 cipher
= IEEE80211_CIPHER_WEP
;
435 else if (alg
== WPA_ALG_TKIP
)
436 cipher
= IEEE80211_CIPHER_TKIP
;
437 else if (alg
== WPA_ALG_CCMP
)
438 cipher
= IEEE80211_CIPHER_AES_CCM
;
440 printf("%s: unknown/unsupported algorithm %d\n",
445 if (key_len
> sizeof(wk
.ik_keydata
)) {
446 printf("%s: key length %d too big\n", __func__
, (int) key_len
);
450 memset(&wk
, 0, sizeof(wk
));
452 wk
.ik_flags
= IEEE80211_KEY_RECV
| IEEE80211_KEY_XMIT
;
454 memset(wk
.ik_macaddr
, 0xff, IEEE80211_ADDR_LEN
);
455 wk
.ik_keyix
= key_idx
;
456 wk
.ik_flags
|= IEEE80211_KEY_DEFAULT
;
458 memcpy(wk
.ik_macaddr
, addr
, IEEE80211_ADDR_LEN
);
459 wk
.ik_keyix
= IEEE80211_KEYIX_NONE
;
461 wk
.ik_keylen
= key_len
;
462 memcpy(wk
.ik_keydata
, key
, key_len
);
464 return set80211var(drv
, IEEE80211_IOC_WPAKEY
, &wk
, sizeof(wk
));
469 bsd_get_seqnum(const char *ifname
, void *priv
, const u8
*addr
, int idx
,
472 struct bsd_driver_data
*drv
= priv
;
473 struct ieee80211req_key wk
;
475 wpa_printf(MSG_DEBUG
, "%s: addr=%s idx=%d",
476 __func__
, ether_sprintf(addr
), idx
);
478 memset(&wk
, 0, sizeof(wk
));
480 memset(wk
.ik_macaddr
, 0xff, IEEE80211_ADDR_LEN
);
482 memcpy(wk
.ik_macaddr
, addr
, IEEE80211_ADDR_LEN
);
485 if (get80211var(drv
, IEEE80211_IOC_WPAKEY
, &wk
, sizeof(wk
)) < 0) {
486 printf("Failed to get encryption.\n");
490 #ifdef WORDS_BIGENDIAN
493 * wk.ik_keytsc is in host byte order (big endian), need to
494 * swap it to match with the byte order used in WPA.
497 u8 tmp
[WPA_KEY_RSC_LEN
];
498 memcpy(tmp
, &wk
.ik_keytsc
, sizeof(wk
.ik_keytsc
));
499 for (i
= 0; i
< WPA_KEY_RSC_LEN
; i
++) {
500 seq
[i
] = tmp
[WPA_KEY_RSC_LEN
- i
- 1];
503 #else /* WORDS_BIGENDIAN */
504 memcpy(seq
, &wk
.ik_keytsc
, sizeof(wk
.ik_keytsc
));
505 #endif /* WORDS_BIGENDIAN */
511 bsd_flush(void *priv
)
513 u8 allsta
[IEEE80211_ADDR_LEN
];
515 memset(allsta
, 0xff, IEEE80211_ADDR_LEN
);
516 return bsd_sta_deauth(priv
, NULL
, allsta
, IEEE80211_REASON_AUTH_LEAVE
);
521 bsd_read_sta_driver_data(void *priv
, struct hostap_sta_driver_data
*data
,
524 struct bsd_driver_data
*drv
= priv
;
525 struct ieee80211req_sta_stats stats
;
527 memcpy(stats
.is_u
.macaddr
, addr
, IEEE80211_ADDR_LEN
);
528 if (get80211var(drv
, IEEE80211_IOC_STA_STATS
, &stats
, sizeof(stats
)) > 0) {
529 /* XXX? do packets counts include non-data frames? */
530 data
->rx_packets
= stats
.is_stats
.ns_rx_data
;
531 data
->rx_bytes
= stats
.is_stats
.ns_rx_bytes
;
532 data
->tx_packets
= stats
.is_stats
.ns_tx_data
;
533 data
->tx_bytes
= stats
.is_stats
.ns_tx_bytes
;
539 bsd_set_opt_ie(const char *ifname
, void *priv
, const u8
*ie
, size_t ie_len
)
542 * Do nothing; we setup parameters at startup that define the
543 * contents of the beacon information element.
549 bsd_sta_deauth(void *priv
, const u8
*own_addr
, const u8
*addr
, int reason_code
)
551 struct bsd_driver_data
*drv
= priv
;
552 struct ieee80211req_mlme mlme
;
554 wpa_printf(MSG_DEBUG
, "%s: addr=%s reason_code=%d",
555 __func__
, ether_sprintf(addr
), reason_code
);
557 mlme
.im_op
= IEEE80211_MLME_DEAUTH
;
558 mlme
.im_reason
= reason_code
;
559 memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
560 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
564 bsd_sta_disassoc(void *priv
, const u8
*own_addr
, const u8
*addr
,
567 struct bsd_driver_data
*drv
= priv
;
568 struct ieee80211req_mlme mlme
;
570 wpa_printf(MSG_DEBUG
, "%s: addr=%s reason_code=%d",
571 __func__
, ether_sprintf(addr
), reason_code
);
573 mlme
.im_op
= IEEE80211_MLME_DISASSOC
;
574 mlme
.im_reason
= reason_code
;
575 memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
576 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
580 bsd_new_sta(struct bsd_driver_data
*drv
, u8 addr
[IEEE80211_ADDR_LEN
])
582 struct hostapd_data
*hapd
= drv
->hapd
;
583 struct ieee80211req_wpaie ie
;
588 * Fetch and validate any negotiated WPA/RSN parameters.
590 memset(&ie
, 0, sizeof(ie
));
591 memcpy(ie
.wpa_macaddr
, addr
, IEEE80211_ADDR_LEN
);
592 if (get80211var(drv
, IEEE80211_IOC_WPAIE
, &ie
, sizeof(ie
)) < 0) {
593 printf("Failed to get WPA/RSN information element.\n");
597 ielen
= ie
.wpa_ie
[1];
604 return hostapd_notif_assoc(hapd
, addr
, iebuf
, ielen
);
608 bsd_wireless_event_receive(int sock
, void *ctx
, void *sock_ctx
)
610 struct bsd_driver_data
*drv
= ctx
;
611 struct hostapd_data
*hapd
= drv
->hapd
;
613 struct if_announcemsghdr
*ifan
;
614 struct rt_msghdr
*rtm
;
615 struct ieee80211_michael_event
*mic
;
616 struct ieee80211_join_event
*join
;
617 struct ieee80211_leave_event
*leave
;
620 n
= read(sock
, buf
, sizeof(buf
));
622 if (errno
!= EINTR
&& errno
!= EAGAIN
)
623 perror("read(PF_ROUTE)");
627 rtm
= (struct rt_msghdr
*) buf
;
628 if (rtm
->rtm_version
!= RTM_VERSION
) {
629 wpa_printf(MSG_DEBUG
, "Routing message version %d not "
630 "understood\n", rtm
->rtm_version
);
633 ifan
= (struct if_announcemsghdr
*) rtm
;
634 switch (rtm
->rtm_type
) {
636 switch (ifan
->ifan_what
) {
637 case RTM_IEEE80211_ASSOC
:
638 case RTM_IEEE80211_REASSOC
:
639 case RTM_IEEE80211_DISASSOC
:
640 case RTM_IEEE80211_SCAN
:
642 case RTM_IEEE80211_LEAVE
:
643 leave
= (struct ieee80211_leave_event
*) &ifan
[1];
644 hostapd_notif_disassoc(drv
->hapd
, leave
->iev_addr
);
646 case RTM_IEEE80211_JOIN
:
647 #ifdef RTM_IEEE80211_REJOIN
648 case RTM_IEEE80211_REJOIN
:
650 join
= (struct ieee80211_join_event
*) &ifan
[1];
651 bsd_new_sta(drv
, join
->iev_addr
);
653 case RTM_IEEE80211_REPLAY
:
656 case RTM_IEEE80211_MICHAEL
:
657 mic
= (struct ieee80211_michael_event
*) &ifan
[1];
658 wpa_printf(MSG_DEBUG
,
659 "Michael MIC failure wireless event: "
660 "keyix=%u src_addr=" MACSTR
, mic
->iev_keyix
,
661 MAC2STR(mic
->iev_src
));
662 hostapd_michael_mic_failure(hapd
, mic
->iev_src
);
670 bsd_wireless_event_init(struct bsd_driver_data
*drv
)
676 s
= socket(PF_ROUTE
, SOCK_RAW
, 0);
678 perror("socket(PF_ROUTE,SOCK_RAW)");
681 eloop_register_read_sock(s
, bsd_wireless_event_receive
, drv
, NULL
);
688 bsd_wireless_event_deinit(struct bsd_driver_data
*drv
)
690 if (drv
->wext_sock
< 0)
692 eloop_unregister_read_sock(drv
->wext_sock
);
693 close(drv
->wext_sock
);
698 bsd_send_eapol(void *priv
, const u8
*addr
, const u8
*data
, size_t data_len
,
699 int encrypt
, const u8
*own_addr
)
701 struct bsd_driver_data
*drv
= priv
;
702 unsigned char buf
[3000];
703 unsigned char *bp
= buf
;
704 struct l2_ethhdr
*eth
;
709 * Prepend the Etherent header. If the caller left us
710 * space at the front we could just insert it but since
711 * we don't know we copy to a local buffer. Given the frequency
712 * and size of frames this probably doesn't matter.
714 len
= data_len
+ sizeof(struct l2_ethhdr
);
715 if (len
> sizeof(buf
)) {
718 printf("EAPOL frame discarded, cannot malloc temp "
719 "buffer of size %u!\n", (unsigned int) len
);
723 eth
= (struct l2_ethhdr
*) bp
;
724 memcpy(eth
->h_dest
, addr
, ETH_ALEN
);
725 memcpy(eth
->h_source
, own_addr
, ETH_ALEN
);
726 eth
->h_proto
= htons(ETH_P_EAPOL
);
727 memcpy(eth
+1, data
, data_len
);
729 wpa_hexdump(MSG_MSGDUMP
, "TX EAPOL", bp
, len
);
731 status
= l2_packet_send(drv
->sock_xmit
, addr
, ETH_P_EAPOL
, bp
, len
);
739 handle_read(void *ctx
, const u8
*src_addr
, const u8
*buf
, size_t len
)
741 struct bsd_driver_data
*drv
= ctx
;
742 hostapd_eapol_receive(drv
->hapd
, src_addr
,
743 buf
+ sizeof(struct l2_ethhdr
),
744 len
- sizeof(struct l2_ethhdr
));
748 hostapd_bsd_get_ssid(const char *ifname
, void *priv
, u8
*buf
, int len
)
750 struct bsd_driver_data
*drv
= priv
;
753 ssid_len
= bsd_get_ssid(drv
->ioctl_sock
, drv
->iface
, buf
);
754 wpa_printf(MSG_DEBUG
, "%s: ssid=\"%.*s\"", __func__
, ssid_len
, buf
);
760 hostapd_bsd_set_ssid(const char *ifname
, void *priv
, const u8
*buf
, int len
)
762 struct bsd_driver_data
*drv
= priv
;
764 wpa_printf(MSG_DEBUG
, "%s: ssid=\"%.*s\"", __func__
, len
, buf
);
766 return bsd_set_ssid(drv
->ioctl_sock
, drv
->iface
, buf
, len
);
770 bsd_init(struct hostapd_data
*hapd
, struct wpa_init_params
*params
)
772 struct bsd_driver_data
*drv
;
774 drv
= os_zalloc(sizeof(struct bsd_driver_data
));
776 printf("Could not allocate memory for bsd driver data\n");
781 drv
->ioctl_sock
= socket(PF_INET
, SOCK_DGRAM
, 0);
782 if (drv
->ioctl_sock
< 0) {
783 perror("socket[PF_INET,SOCK_DGRAM]");
786 memcpy(drv
->iface
, params
->ifname
, sizeof(drv
->iface
));
788 drv
->sock_xmit
= l2_packet_init(drv
->iface
, NULL
, ETH_P_EAPOL
,
789 handle_read
, drv
, 1);
790 if (drv
->sock_xmit
== NULL
)
792 if (l2_packet_get_own_addr(drv
->sock_xmit
, params
->own_addr
))
795 bsd_set_iface_flags(drv
, 0); /* mark down during setup */
796 if (bsd_wireless_event_init(drv
))
801 if (drv
->sock_xmit
!= NULL
)
802 l2_packet_deinit(drv
->sock_xmit
);
803 if (drv
->ioctl_sock
>= 0)
804 close(drv
->ioctl_sock
);
812 bsd_deinit(void *priv
)
814 struct bsd_driver_data
*drv
= priv
;
816 bsd_wireless_event_deinit(drv
);
817 (void) bsd_set_iface_flags(drv
, 0);
818 if (drv
->ioctl_sock
>= 0)
819 close(drv
->ioctl_sock
);
820 if (drv
->sock_xmit
!= NULL
)
821 l2_packet_deinit(drv
->sock_xmit
);
825 const struct wpa_driver_ops wpa_driver_bsd_ops
= {
827 .hapd_init
= bsd_init
,
828 .hapd_deinit
= bsd_deinit
,
829 .set_ieee8021x
= bsd_set_ieee8021x
,
830 .set_privacy
= bsd_set_privacy
,
831 .set_key
= bsd_set_key
,
832 .get_seqnum
= bsd_get_seqnum
,
834 .set_generic_elem
= bsd_set_opt_ie
,
835 .sta_set_flags
= bsd_sta_set_flags
,
836 .read_sta_data
= bsd_read_sta_driver_data
,
837 .hapd_send_eapol
= bsd_send_eapol
,
838 .sta_disassoc
= bsd_sta_disassoc
,
839 .sta_deauth
= bsd_sta_deauth
,
840 .hapd_set_ssid
= hostapd_bsd_set_ssid
,
841 .hapd_get_ssid
= hostapd_bsd_get_ssid
,
846 struct wpa_driver_bsd_data
{
847 int sock
; /* open socket for 802.11 ioctls */
848 int route
; /* routing socket for events */
849 char ifname
[IFNAMSIZ
+1]; /* interface name */
850 unsigned int ifindex
; /* interface index */
852 int prev_roaming
; /* roaming state to restore on deinit */
853 int prev_privacy
; /* privacy state to restore on deinit */
854 int prev_wpa
; /* wpa state to restore on deinit */
858 set80211var(struct wpa_driver_bsd_data
*drv
, int op
, const void *arg
, int arg_len
)
860 return bsd_set80211var(drv
->sock
, drv
->ifname
, op
, arg
, arg_len
);
864 get80211var(struct wpa_driver_bsd_data
*drv
, int op
, void *arg
, int arg_len
)
866 return bsd_get80211var(drv
->sock
, drv
->ifname
, op
, arg
, arg_len
);
870 set80211param(struct wpa_driver_bsd_data
*drv
, int op
, int arg
)
872 return bsd_set80211param(drv
->sock
, drv
->ifname
, op
, arg
);
876 get80211param(struct wpa_driver_bsd_data
*drv
, int op
)
878 struct ieee80211req ireq
;
880 os_memset(&ireq
, 0, sizeof(ireq
));
881 os_strlcpy(ireq
.i_name
, drv
->ifname
, sizeof(ireq
.i_name
));
884 if (ioctl(drv
->sock
, SIOCG80211
, &ireq
) < 0) {
885 fprintf(stderr
, "ioctl[SIOCG80211, op %u]: %s\n",
886 op
, strerror(errno
));
893 getifflags(struct wpa_driver_bsd_data
*drv
, int *flags
)
897 os_memset(&ifr
, 0, sizeof(ifr
));
898 os_strlcpy(ifr
.ifr_name
, drv
->ifname
, sizeof(ifr
.ifr_name
));
899 if (ioctl(drv
->sock
, SIOCGIFFLAGS
, (caddr_t
)&ifr
) < 0) {
900 perror("SIOCGIFFLAGS");
903 *flags
= ifr
.ifr_flags
& 0xffff;
908 setifflags(struct wpa_driver_bsd_data
*drv
, int flags
)
912 os_memset(&ifr
, 0, sizeof(ifr
));
913 os_strlcpy(ifr
.ifr_name
, drv
->ifname
, sizeof(ifr
.ifr_name
));
914 ifr
.ifr_flags
= flags
& 0xffff;
915 if (ioctl(drv
->sock
, SIOCSIFFLAGS
, (caddr_t
)&ifr
) < 0) {
916 perror("SIOCSIFFLAGS");
923 wpa_driver_bsd_get_bssid(void *priv
, u8
*bssid
)
925 struct wpa_driver_bsd_data
*drv
= priv
;
926 #ifdef SIOCG80211BSSID
927 struct ieee80211_bssid bs
;
929 os_strncpy(bs
.i_name
, drv
->ifname
, sizeof(bs
.i_name
));
930 if (ioctl(drv
->sock
, SIOCG80211BSSID
, &bs
) < 0)
932 os_memcpy(bssid
, bs
.i_bssid
, sizeof(bs
.i_bssid
));
935 return get80211var(drv
, IEEE80211_IOC_BSSID
,
936 bssid
, IEEE80211_ADDR_LEN
) < 0 ? -1 : 0;
942 wpa_driver_bsd_set_bssid(void *priv
, const char *bssid
)
944 struct wpa_driver_bsd_data
*drv
= priv
;
946 return set80211var(drv
, IEEE80211_IOC_BSSID
,
947 bssid
, IEEE80211_ADDR_LEN
);
952 wpa_driver_bsd_get_ssid(void *priv
, u8
*ssid
)
954 struct wpa_driver_bsd_data
*drv
= priv
;
956 return bsd_get_ssid(drv
->sock
, drv
->ifname
, ssid
);
960 wpa_driver_bsd_set_ssid(void *priv
, const u8
*ssid
,
963 struct wpa_driver_bsd_data
*drv
= priv
;
965 return bsd_set_ssid(drv
->sock
, drv
->ifname
, ssid
, ssid_len
);
969 wpa_driver_bsd_set_wpa_ie(struct wpa_driver_bsd_data
*drv
,
970 const u8
*wpa_ie
, size_t wpa_ie_len
)
972 return set80211var(drv
, IEEE80211_IOC_OPTIE
, wpa_ie
, wpa_ie_len
);
976 wpa_driver_bsd_set_wpa_internal(void *priv
, int wpa
, int privacy
)
978 struct wpa_driver_bsd_data
*drv
= priv
;
981 wpa_printf(MSG_DEBUG
, "%s: wpa=%d privacy=%d",
982 __FUNCTION__
, wpa
, privacy
);
984 if (!wpa
&& wpa_driver_bsd_set_wpa_ie(drv
, NULL
, 0) < 0)
986 if (set80211param(drv
, IEEE80211_IOC_PRIVACY
, privacy
) < 0)
988 if (set80211param(drv
, IEEE80211_IOC_WPA
, wpa
) < 0)
995 wpa_driver_bsd_set_wpa(void *priv
, int enabled
)
997 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __FUNCTION__
, enabled
);
999 return wpa_driver_bsd_set_wpa_internal(priv
, enabled
? 3 : 0, enabled
);
1003 wpa_driver_bsd_del_key(struct wpa_driver_bsd_data
*drv
, int key_idx
,
1004 const unsigned char *addr
)
1006 struct ieee80211req_del_key wk
;
1008 os_memset(&wk
, 0, sizeof(wk
));
1010 bcmp(addr
, "\xff\xff\xff\xff\xff\xff", IEEE80211_ADDR_LEN
) != 0) {
1011 struct ether_addr ea
;
1013 os_memcpy(&ea
, addr
, IEEE80211_ADDR_LEN
);
1014 wpa_printf(MSG_DEBUG
, "%s: addr=%s keyidx=%d",
1015 __func__
, ether_ntoa(&ea
), key_idx
);
1016 os_memcpy(wk
.idk_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1017 wk
.idk_keyix
= (uint8_t) IEEE80211_KEYIX_NONE
;
1019 wpa_printf(MSG_DEBUG
, "%s: keyidx=%d", __func__
, key_idx
);
1020 wk
.idk_keyix
= key_idx
;
1022 return set80211var(drv
, IEEE80211_IOC_DELKEY
, &wk
, sizeof(wk
));
1026 wpa_driver_bsd_set_key(const char *ifname
, void *priv
, wpa_alg alg
,
1027 const unsigned char *addr
, int key_idx
, int set_tx
,
1028 const u8
*seq
, size_t seq_len
,
1029 const u8
*key
, size_t key_len
)
1031 struct wpa_driver_bsd_data
*drv
= priv
;
1032 struct ieee80211req_key wk
;
1033 struct ether_addr ea
;
1037 if (alg
== WPA_ALG_NONE
)
1038 return wpa_driver_bsd_del_key(drv
, key_idx
, addr
);
1043 cipher
= IEEE80211_CIPHER_WEP
;
1047 cipher
= IEEE80211_CIPHER_TKIP
;
1051 cipher
= IEEE80211_CIPHER_AES_CCM
;
1054 wpa_printf(MSG_DEBUG
, "%s: unknown/unsupported algorithm %d",
1059 os_memcpy(&ea
, addr
, IEEE80211_ADDR_LEN
);
1060 wpa_printf(MSG_DEBUG
,
1061 "%s: alg=%s addr=%s key_idx=%d set_tx=%d seq_len=%zu key_len=%zu",
1062 __func__
, alg_name
, ether_ntoa(&ea
), key_idx
, set_tx
,
1065 if (seq_len
> sizeof(u_int64_t
)) {
1066 wpa_printf(MSG_DEBUG
, "%s: seq_len %zu too big",
1070 if (key_len
> sizeof(wk
.ik_keydata
)) {
1071 wpa_printf(MSG_DEBUG
, "%s: key length %zu too big",
1076 os_memset(&wk
, 0, sizeof(wk
));
1077 wk
.ik_type
= cipher
;
1078 wk
.ik_flags
= IEEE80211_KEY_RECV
;
1080 wk
.ik_flags
|= IEEE80211_KEY_XMIT
;
1081 os_memcpy(wk
.ik_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1083 * Deduce whether group/global or unicast key by checking
1084 * the address (yech). Note also that we can only mark global
1085 * keys default; doing this for a unicast key is an error.
1087 if (bcmp(addr
, "\xff\xff\xff\xff\xff\xff", IEEE80211_ADDR_LEN
) == 0) {
1088 wk
.ik_flags
|= IEEE80211_KEY_GROUP
;
1089 wk
.ik_keyix
= key_idx
;
1091 wk
.ik_keyix
= (key_idx
== 0 ? IEEE80211_KEYIX_NONE
: key_idx
);
1093 if (wk
.ik_keyix
!= IEEE80211_KEYIX_NONE
&& set_tx
)
1094 wk
.ik_flags
|= IEEE80211_KEY_DEFAULT
;
1095 wk
.ik_keylen
= key_len
;
1096 os_memcpy(&wk
.ik_keyrsc
, seq
, seq_len
);
1097 os_memcpy(wk
.ik_keydata
, key
, key_len
);
1099 return set80211var(drv
, IEEE80211_IOC_WPAKEY
, &wk
, sizeof(wk
));
1103 wpa_driver_bsd_set_countermeasures(void *priv
, int enabled
)
1105 struct wpa_driver_bsd_data
*drv
= priv
;
1107 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
1108 return set80211param(drv
, IEEE80211_IOC_COUNTERMEASURES
, enabled
);
1113 wpa_driver_bsd_set_drop_unencrypted(void *priv
, int enabled
)
1115 struct wpa_driver_bsd_data
*drv
= priv
;
1117 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
1118 return set80211param(drv
, IEEE80211_IOC_DROPUNENCRYPTED
, enabled
);
1122 wpa_driver_bsd_deauthenticate(void *priv
, const u8
*addr
, int reason_code
)
1124 struct wpa_driver_bsd_data
*drv
= priv
;
1125 struct ieee80211req_mlme mlme
;
1127 wpa_printf(MSG_DEBUG
, "%s", __func__
);
1128 os_memset(&mlme
, 0, sizeof(mlme
));
1129 mlme
.im_op
= IEEE80211_MLME_DEAUTH
;
1130 mlme
.im_reason
= reason_code
;
1131 os_memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1132 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
1136 wpa_driver_bsd_disassociate(void *priv
, const u8
*addr
, int reason_code
)
1138 struct wpa_driver_bsd_data
*drv
= priv
;
1139 struct ieee80211req_mlme mlme
;
1141 wpa_printf(MSG_DEBUG
, "%s", __func__
);
1142 os_memset(&mlme
, 0, sizeof(mlme
));
1143 mlme
.im_op
= IEEE80211_MLME_DISASSOC
;
1144 mlme
.im_reason
= reason_code
;
1145 os_memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1146 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
1150 wpa_driver_bsd_associate(void *priv
, struct wpa_driver_associate_params
*params
)
1152 struct wpa_driver_bsd_data
*drv
= priv
;
1153 struct ieee80211req_mlme mlme
;
1157 wpa_printf(MSG_DEBUG
,
1158 "%s: ssid '%.*s' wpa ie len %u pairwise %u group %u key mgmt %u"
1160 , (unsigned int) params
->ssid_len
, params
->ssid
1161 , (unsigned int) params
->wpa_ie_len
1162 , params
->pairwise_suite
1163 , params
->group_suite
1164 , params
->key_mgmt_suite
1167 if (wpa_driver_bsd_set_drop_unencrypted(drv
, params
->drop_unencrypted
)
1170 if (wpa_driver_bsd_set_auth_alg(drv
, params
->auth_alg
) < 0)
1172 /* XXX error handling is wrong but unclear what to do... */
1173 if (wpa_driver_bsd_set_wpa_ie(drv
, params
->wpa_ie
, params
->wpa_ie_len
) < 0)
1176 privacy
= !(params
->pairwise_suite
== CIPHER_NONE
&&
1177 params
->group_suite
== CIPHER_NONE
&&
1178 params
->key_mgmt_suite
== KEY_MGMT_NONE
&&
1179 params
->wpa_ie_len
== 0);
1180 wpa_printf(MSG_DEBUG
, "%s: set PRIVACY %u", __func__
, privacy
);
1182 if (set80211param(drv
, IEEE80211_IOC_PRIVACY
, privacy
) < 0)
1185 if (params
->wpa_ie_len
&&
1186 set80211param(drv
, IEEE80211_IOC_WPA
,
1187 params
->wpa_ie
[0] == WLAN_EID_RSN
? 2 : 1) < 0)
1190 os_memset(&mlme
, 0, sizeof(mlme
));
1191 mlme
.im_op
= IEEE80211_MLME_ASSOC
;
1192 if (params
->ssid
!= NULL
)
1193 os_memcpy(mlme
.im_ssid
, params
->ssid
, params
->ssid_len
);
1194 mlme
.im_ssid_len
= params
->ssid_len
;
1195 if (params
->bssid
!= NULL
)
1196 os_memcpy(mlme
.im_macaddr
, params
->bssid
, IEEE80211_ADDR_LEN
);
1197 if (set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
)) < 0)
1203 wpa_driver_bsd_set_auth_alg(void *priv
, int auth_alg
)
1205 struct wpa_driver_bsd_data
*drv
= priv
;
1208 if ((auth_alg
& AUTH_ALG_OPEN_SYSTEM
) &&
1209 (auth_alg
& AUTH_ALG_SHARED_KEY
))
1210 authmode
= IEEE80211_AUTH_AUTO
;
1211 else if (auth_alg
& AUTH_ALG_SHARED_KEY
)
1212 authmode
= IEEE80211_AUTH_SHARED
;
1214 authmode
= IEEE80211_AUTH_OPEN
;
1216 return set80211param(drv
, IEEE80211_IOC_AUTHMODE
, authmode
);
1220 wpa_driver_bsd_scan(void *priv
, const u8
*ssid
, size_t ssid_len
)
1222 struct wpa_driver_bsd_data
*drv
= priv
;
1225 /* NB: interface must be marked UP to do a scan */
1226 if (getifflags(drv
, &flags
) != 0 || setifflags(drv
, flags
| IFF_UP
) != 0)
1229 /* set desired ssid before scan */
1230 if (wpa_driver_bsd_set_ssid(drv
, ssid
, ssid_len
) < 0)
1233 /* NB: net80211 delivers a scan complete event so no need to poll */
1234 return set80211param(drv
, IEEE80211_IOC_SCAN_REQ
, 0);
1238 wpa_driver_bsd_event_receive(int sock
, void *ctx
, void *sock_ctx
)
1240 struct wpa_driver_bsd_data
*drv
= sock_ctx
;
1242 struct if_announcemsghdr
*ifan
;
1243 struct if_msghdr
*ifm
;
1244 struct rt_msghdr
*rtm
;
1245 union wpa_event_data event
;
1246 struct ieee80211_michael_event
*mic
;
1249 n
= read(sock
, buf
, sizeof(buf
));
1251 if (errno
!= EINTR
&& errno
!= EAGAIN
)
1252 perror("read(PF_ROUTE)");
1256 rtm
= (struct rt_msghdr
*) buf
;
1257 if (rtm
->rtm_version
!= RTM_VERSION
) {
1258 wpa_printf(MSG_DEBUG
, "Routing message version %d not "
1259 "understood\n", rtm
->rtm_version
);
1262 os_memset(&event
, 0, sizeof(event
));
1263 switch (rtm
->rtm_type
) {
1264 case RTM_IFANNOUNCE
:
1265 ifan
= (struct if_announcemsghdr
*) rtm
;
1266 if (ifan
->ifan_index
!= drv
->ifindex
)
1268 strlcpy(event
.interface_status
.ifname
, drv
->ifname
,
1269 sizeof(event
.interface_status
.ifname
));
1270 switch (ifan
->ifan_what
) {
1271 case IFAN_DEPARTURE
:
1272 event
.interface_status
.ievent
= EVENT_INTERFACE_REMOVED
;
1276 wpa_printf(MSG_DEBUG
, "RTM_IFANNOUNCE: Interface '%s' %s",
1277 event
.interface_status
.ifname
,
1278 ifan
->ifan_what
== IFAN_DEPARTURE
?
1279 "removed" : "added");
1280 wpa_supplicant_event(ctx
, EVENT_INTERFACE_STATUS
, &event
);
1283 ifan
= (struct if_announcemsghdr
*) rtm
;
1284 if (ifan
->ifan_index
!= drv
->ifindex
)
1286 switch (ifan
->ifan_what
) {
1287 case RTM_IEEE80211_ASSOC
:
1288 case RTM_IEEE80211_REASSOC
:
1289 wpa_supplicant_event(ctx
, EVENT_ASSOC
, NULL
);
1291 case RTM_IEEE80211_DISASSOC
:
1292 wpa_supplicant_event(ctx
, EVENT_DISASSOC
, NULL
);
1294 case RTM_IEEE80211_SCAN
:
1295 wpa_supplicant_event(ctx
, EVENT_SCAN_RESULTS
, NULL
);
1297 case RTM_IEEE80211_REPLAY
:
1300 case RTM_IEEE80211_MICHAEL
:
1301 mic
= (struct ieee80211_michael_event
*) &ifan
[1];
1302 wpa_printf(MSG_DEBUG
,
1303 "Michael MIC failure wireless event: "
1304 "keyix=%u src_addr=" MACSTR
, mic
->iev_keyix
,
1305 MAC2STR(mic
->iev_src
));
1307 os_memset(&event
, 0, sizeof(event
));
1308 event
.michael_mic_failure
.unicast
=
1309 !IEEE80211_IS_MULTICAST(mic
->iev_dst
);
1310 wpa_supplicant_event(ctx
, EVENT_MICHAEL_MIC_FAILURE
,
1316 ifm
= (struct if_msghdr
*) rtm
;
1317 if (ifm
->ifm_index
!= drv
->ifindex
)
1319 if ((rtm
->rtm_flags
& RTF_UP
) == 0) {
1320 strlcpy(event
.interface_status
.ifname
, drv
->ifname
,
1321 sizeof(event
.interface_status
.ifname
));
1322 event
.interface_status
.ievent
= EVENT_INTERFACE_REMOVED
;
1323 wpa_printf(MSG_DEBUG
, "RTM_IFINFO: Interface '%s' DOWN",
1324 event
.interface_status
.ifname
);
1325 wpa_supplicant_event(ctx
, EVENT_INTERFACE_STATUS
, &event
);
1332 wpa_driver_bsd_add_scan_entry(struct wpa_scan_results
*res
,
1333 struct ieee80211req_scan_result
*sr
)
1335 struct wpa_scan_res
*result
, **tmp
;
1339 extra_len
= 2 + sr
->isr_ssid_len
;
1340 extra_len
+= 2 + sr
->isr_nrates
;
1341 extra_len
+= 3; /* ERP IE */
1342 extra_len
+= sr
->isr_ie_len
;
1344 result
= os_zalloc(sizeof(*result
) + extra_len
);
1347 os_memcpy(result
->bssid
, sr
->isr_bssid
, ETH_ALEN
);
1348 result
->freq
= sr
->isr_freq
;
1349 result
->beacon_int
= sr
->isr_intval
;
1350 result
->caps
= sr
->isr_capinfo
;
1351 result
->qual
= sr
->isr_rssi
;
1352 result
->noise
= sr
->isr_noise
;
1354 pos
= (u8
*)(result
+ 1);
1356 *pos
++ = WLAN_EID_SSID
;
1357 *pos
++ = sr
->isr_ssid_len
;
1358 os_memcpy(pos
, sr
+ 1, sr
->isr_ssid_len
);
1359 pos
+= sr
->isr_ssid_len
;
1362 * Deal all rates as supported rate.
1363 * Because net80211 doesn't report extended supported rate or not.
1365 *pos
++ = WLAN_EID_SUPP_RATES
;
1366 *pos
++ = sr
->isr_nrates
;
1367 os_memcpy(pos
, sr
->isr_rates
, sr
->isr_nrates
);
1368 pos
+= sr
->isr_nrates
;
1370 *pos
++ = WLAN_EID_ERP_INFO
;
1372 *pos
++ = sr
->isr_erp
;
1374 os_memcpy(pos
, (u8
*)(sr
+ 1) + sr
->isr_ssid_len
, sr
->isr_ie_len
);
1375 pos
+= sr
->isr_ie_len
;
1377 result
->ie_len
= pos
- (u8
*)(result
+ 1);
1379 tmp
= os_realloc(res
->res
,
1380 (res
->num
+ 1) * sizeof(struct wpa_scan_res
*));
1385 tmp
[res
->num
++] = result
;
1389 struct wpa_scan_results
*
1390 wpa_driver_bsd_get_scan_results2(void *priv
)
1392 struct wpa_driver_bsd_data
*drv
= priv
;
1393 struct ieee80211req_scan_result
*sr
;
1394 struct wpa_scan_results
*res
;
1396 uint8_t buf
[24*1024], *pos
;
1398 len
= get80211var(drv
, IEEE80211_IOC_SCAN_RESULTS
, buf
, 24*1024);
1402 res
= os_zalloc(sizeof(*res
));
1408 while (rest
>= sizeof(struct ieee80211req_scan_result
)) {
1409 sr
= (struct ieee80211req_scan_result
*)pos
;
1410 wpa_driver_bsd_add_scan_entry(res
, sr
);
1412 rest
-= sr
->isr_len
;
1415 wpa_printf(MSG_DEBUG
, "Received %d bytes of scan results (%lu BSSes)",
1416 len
, (unsigned long)res
->num
);
1422 wpa_driver_bsd_init(void *ctx
, const char *ifname
)
1424 #define GETPARAM(drv, param, v) \
1425 (((v) = get80211param(drv, param)) != -1)
1426 struct wpa_driver_bsd_data
*drv
;
1428 drv
= os_zalloc(sizeof(*drv
));
1432 * NB: We require the interface name be mappable to an index.
1433 * This implies we do not support having wpa_supplicant
1434 * wait for an interface to appear. This seems ok; that
1435 * doesn't belong here; it's really the job of devd.
1437 drv
->ifindex
= if_nametoindex(ifname
);
1438 if (drv
->ifindex
== 0) {
1439 wpa_printf(MSG_DEBUG
, "%s: interface %s does not exist",
1443 drv
->sock
= socket(PF_INET
, SOCK_DGRAM
, 0);
1446 drv
->route
= socket(PF_ROUTE
, SOCK_RAW
, 0);
1449 eloop_register_read_sock(drv
->route
,
1450 wpa_driver_bsd_event_receive
, ctx
, drv
);
1453 os_strlcpy(drv
->ifname
, ifname
, sizeof(drv
->ifname
));
1455 if (!GETPARAM(drv
, IEEE80211_IOC_ROAMING
, drv
->prev_roaming
)) {
1456 wpa_printf(MSG_DEBUG
, "%s: failed to get roaming state: %s",
1457 __func__
, strerror(errno
));
1460 if (!GETPARAM(drv
, IEEE80211_IOC_PRIVACY
, drv
->prev_privacy
)) {
1461 wpa_printf(MSG_DEBUG
, "%s: failed to get privacy state: %s",
1462 __func__
, strerror(errno
));
1465 if (!GETPARAM(drv
, IEEE80211_IOC_WPA
, drv
->prev_wpa
)) {
1466 wpa_printf(MSG_DEBUG
, "%s: failed to get wpa state: %s",
1467 __func__
, strerror(errno
));
1470 if (set80211param(drv
, IEEE80211_IOC_ROAMING
, IEEE80211_ROAMING_MANUAL
) < 0) {
1471 wpa_printf(MSG_DEBUG
, "%s: failed to set wpa_supplicant-based "
1472 "roaming: %s", __func__
, strerror(errno
));
1476 if (set80211param(drv
, IEEE80211_IOC_WPA
, 1+2) < 0) {
1477 wpa_printf(MSG_DEBUG
, "%s: failed to enable WPA support %s",
1478 __func__
, strerror(errno
));
1482 wpa_driver_bsd_set_wpa(drv
, 1);
1494 wpa_driver_bsd_deinit(void *priv
)
1496 struct wpa_driver_bsd_data
*drv
= priv
;
1499 wpa_driver_bsd_set_wpa(drv
, 0);
1500 eloop_unregister_read_sock(drv
->route
);
1502 /* NB: mark interface down */
1503 if (getifflags(drv
, &flags
) == 0)
1504 (void) setifflags(drv
, flags
&~ IFF_UP
);
1506 wpa_driver_bsd_set_wpa_internal(drv
, drv
->prev_wpa
, drv
->prev_privacy
);
1507 if (set80211param(drv
, IEEE80211_IOC_ROAMING
, drv
->prev_roaming
) < 0)
1508 wpa_printf(MSG_DEBUG
, "%s: failed to restore roaming state",
1511 (void) close(drv
->route
); /* ioctl socket */
1512 (void) close(drv
->sock
); /* event socket */
1517 const struct wpa_driver_ops wpa_driver_bsd_ops
= {
1519 .desc
= "BSD 802.11 support",
1520 .init
= wpa_driver_bsd_init
,
1521 .deinit
= wpa_driver_bsd_deinit
,
1522 .get_bssid
= wpa_driver_bsd_get_bssid
,
1523 .get_ssid
= wpa_driver_bsd_get_ssid
,
1524 .set_key
= wpa_driver_bsd_set_key
,
1525 .set_countermeasures
= wpa_driver_bsd_set_countermeasures
,
1526 .scan
= wpa_driver_bsd_scan
,
1527 .get_scan_results2
= wpa_driver_bsd_get_scan_results2
,
1528 .deauthenticate
= wpa_driver_bsd_deauthenticate
,
1529 .disassociate
= wpa_driver_bsd_disassociate
,
1530 .associate
= wpa_driver_bsd_associate
,
1533 #endif /* HOSTAPD */