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 "common/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"
158 struct bsd_driver_data
{
159 struct hostapd_data
*hapd
; /* back pointer */
161 char iface
[IFNAMSIZ
+ 1];
162 struct l2_packet_data
*sock_xmit
; /* raw packet xmit socket */
163 int ioctl_sock
; /* socket for ioctl() use */
164 int wext_sock
; /* socket for wireless events */
167 static int bsd_sta_deauth(void *priv
, const u8
*own_addr
, const u8
*addr
,
171 set80211var(struct bsd_driver_data
*drv
, int op
, const void *arg
, int arg_len
)
173 return bsd_set80211var(drv
->ioctl_sock
, drv
->iface
, op
, arg
, arg_len
);
177 get80211var(struct bsd_driver_data
*drv
, int op
, void *arg
, int arg_len
)
179 return bsd_get80211var(drv
->ioctl_sock
, drv
->iface
, op
, arg
, arg_len
);
183 set80211param(struct bsd_driver_data
*drv
, int op
, int arg
)
185 return bsd_set80211param(drv
->ioctl_sock
, drv
->iface
, op
, arg
);
189 ether_sprintf(const u8
*addr
)
191 static char buf
[sizeof(MACSTR
)];
194 snprintf(buf
, sizeof(buf
), MACSTR
, MAC2STR(addr
));
196 snprintf(buf
, sizeof(buf
), MACSTR
, 0,0,0,0,0,0);
201 * Configure WPA parameters.
204 bsd_configure_wpa(struct bsd_driver_data
*drv
, struct wpa_bss_params
*params
)
206 static const char *ciphernames
[] =
207 { "WEP", "TKIP", "AES-OCB", "AES-CCM", "CKIP", "NONE" };
210 switch (params
->wpa_group
) {
211 case WPA_CIPHER_CCMP
:
212 v
= IEEE80211_CIPHER_AES_CCM
;
214 case WPA_CIPHER_TKIP
:
215 v
= IEEE80211_CIPHER_TKIP
;
217 case WPA_CIPHER_WEP104
:
218 v
= IEEE80211_CIPHER_WEP
;
220 case WPA_CIPHER_WEP40
:
221 v
= IEEE80211_CIPHER_WEP
;
223 case WPA_CIPHER_NONE
:
224 v
= IEEE80211_CIPHER_NONE
;
227 printf("Unknown group key cipher %u\n",
231 wpa_printf(MSG_DEBUG
, "%s: group key cipher=%s (%u)",
232 __func__
, ciphernames
[v
], v
);
233 if (set80211param(drv
, IEEE80211_IOC_MCASTCIPHER
, v
)) {
234 printf("Unable to set group key cipher to %u (%s)\n",
238 if (v
== IEEE80211_CIPHER_WEP
) {
239 /* key length is done only for specific ciphers */
240 v
= (params
->wpa_group
== WPA_CIPHER_WEP104
? 13 : 5);
241 if (set80211param(drv
, IEEE80211_IOC_MCASTKEYLEN
, v
)) {
242 printf("Unable to set group key length to %u\n", v
);
248 if (params
->wpa_pairwise
& WPA_CIPHER_CCMP
)
249 v
|= 1<<IEEE80211_CIPHER_AES_CCM
;
250 if (params
->wpa_pairwise
& WPA_CIPHER_TKIP
)
251 v
|= 1<<IEEE80211_CIPHER_TKIP
;
252 if (params
->wpa_pairwise
& WPA_CIPHER_NONE
)
253 v
|= 1<<IEEE80211_CIPHER_NONE
;
254 wpa_printf(MSG_DEBUG
, "%s: pairwise key ciphers=0x%x", __func__
, v
);
255 if (set80211param(drv
, IEEE80211_IOC_UCASTCIPHERS
, v
)) {
256 printf("Unable to set pairwise key ciphers to 0x%x\n", v
);
260 wpa_printf(MSG_DEBUG
, "%s: key management algorithms=0x%x",
261 __func__
, params
->wpa_key_mgmt
);
262 if (set80211param(drv
, IEEE80211_IOC_KEYMGTALGS
, params
->wpa_key_mgmt
))
264 printf("Unable to set key management algorithms to 0x%x\n",
265 params
->wpa_key_mgmt
);
270 if (params
->rsn_preauth
)
272 wpa_printf(MSG_DEBUG
, "%s: rsn capabilities=0x%x",
273 __func__
, params
->rsn_preauth
);
274 if (set80211param(drv
, IEEE80211_IOC_RSNCAPS
, v
)) {
275 printf("Unable to set RSN capabilities to 0x%x\n", v
);
279 wpa_printf(MSG_DEBUG
, "%s: enable WPA= 0x%x", __func__
, params
->wpa
);
280 if (set80211param(drv
, IEEE80211_IOC_WPA
, params
->wpa
)) {
281 printf("Unable to set WPA to %u\n", params
->wpa
);
289 bsd_set_iface_flags(void *priv
, int dev_up
)
291 struct bsd_driver_data
*drv
= priv
;
294 wpa_printf(MSG_DEBUG
, "%s: dev_up=%d", __func__
, dev_up
);
296 if (drv
->ioctl_sock
< 0)
299 memset(&ifr
, 0, sizeof(ifr
));
300 os_strlcpy(ifr
.ifr_name
, drv
->iface
, sizeof(ifr
.ifr_name
));
302 if (ioctl(drv
->ioctl_sock
, SIOCGIFFLAGS
, &ifr
) != 0) {
303 perror("ioctl[SIOCGIFFLAGS]");
308 ifr
.ifr_flags
|= IFF_UP
;
310 ifr
.ifr_flags
&= ~IFF_UP
;
312 if (ioctl(drv
->ioctl_sock
, SIOCSIFFLAGS
, &ifr
) != 0) {
313 perror("ioctl[SIOCSIFFLAGS]");
321 bsd_set_ieee8021x(void *priv
, struct wpa_bss_params
*params
)
323 struct bsd_driver_data
*drv
= priv
;
325 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, params
->enabled
);
327 if (!params
->enabled
) {
328 /* XXX restore state */
329 return set80211param(priv
, IEEE80211_IOC_AUTHMODE
,
330 IEEE80211_AUTH_AUTO
);
332 if (!params
->wpa
&& !params
->ieee802_1x
) {
333 hostapd_logger(drv
->hapd
, NULL
, HOSTAPD_MODULE_DRIVER
,
334 HOSTAPD_LEVEL_WARNING
, "No 802.1X or WPA enabled!");
337 if (params
->wpa
&& bsd_configure_wpa(drv
, params
) != 0) {
338 hostapd_logger(drv
->hapd
, NULL
, HOSTAPD_MODULE_DRIVER
,
339 HOSTAPD_LEVEL_WARNING
, "Error configuring WPA state!");
342 if (set80211param(priv
, IEEE80211_IOC_AUTHMODE
,
343 (params
->wpa
? IEEE80211_AUTH_WPA
: IEEE80211_AUTH_8021X
))) {
344 hostapd_logger(drv
->hapd
, NULL
, HOSTAPD_MODULE_DRIVER
,
345 HOSTAPD_LEVEL_WARNING
, "Error enabling WPA/802.1X!");
348 return bsd_set_iface_flags(priv
, 1);
352 bsd_set_privacy(const char *ifname
, void *priv
, int enabled
)
354 struct bsd_driver_data
*drv
= priv
;
356 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
358 return set80211param(drv
, IEEE80211_IOC_PRIVACY
, enabled
);
362 bsd_set_sta_authorized(void *priv
, const u8
*addr
, int authorized
)
364 struct bsd_driver_data
*drv
= priv
;
365 struct ieee80211req_mlme mlme
;
367 wpa_printf(MSG_DEBUG
, "%s: addr=%s authorized=%d",
368 __func__
, ether_sprintf(addr
), authorized
);
371 mlme
.im_op
= IEEE80211_MLME_AUTHORIZE
;
373 mlme
.im_op
= IEEE80211_MLME_UNAUTHORIZE
;
375 memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
376 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
380 bsd_sta_set_flags(void *priv
, const u8
*addr
, int total_flags
, int flags_or
,
383 /* For now, only support setting Authorized flag */
384 if (flags_or
& WPA_STA_AUTHORIZED
)
385 return bsd_set_sta_authorized(priv
, addr
, 1);
386 if (!(flags_and
& WPA_STA_AUTHORIZED
))
387 return bsd_set_sta_authorized(priv
, addr
, 0);
392 bsd_del_key(void *priv
, const u8
*addr
, int key_idx
)
394 struct bsd_driver_data
*drv
= priv
;
395 struct ieee80211req_del_key wk
;
397 wpa_printf(MSG_DEBUG
, "%s: addr=%s key_idx=%d",
398 __func__
, ether_sprintf(addr
), key_idx
);
400 memset(&wk
, 0, sizeof(wk
));
402 memcpy(wk
.idk_macaddr
, addr
, IEEE80211_ADDR_LEN
);
403 wk
.idk_keyix
= (u_int8_t
) IEEE80211_KEYIX_NONE
; /* XXX */
405 wk
.idk_keyix
= key_idx
;
408 return set80211var(drv
, IEEE80211_IOC_DELKEY
, &wk
, sizeof(wk
));
412 bsd_set_key(const char *ifname
, void *priv
, wpa_alg alg
,
413 const u8
*addr
, int key_idx
, int set_tx
, const u8
*seq
,
414 size_t seq_len
, const u8
*key
, size_t key_len
)
416 struct bsd_driver_data
*drv
= priv
;
417 struct ieee80211req_key wk
;
420 if (alg
== WPA_ALG_NONE
)
421 return bsd_del_key(drv
, addr
, key_idx
);
423 wpa_printf(MSG_DEBUG
, "%s: alg=%d addr=%s key_idx=%d",
424 __func__
, alg
, ether_sprintf(addr
), key_idx
);
426 if (alg
== WPA_ALG_WEP
)
427 cipher
= IEEE80211_CIPHER_WEP
;
428 else if (alg
== WPA_ALG_TKIP
)
429 cipher
= IEEE80211_CIPHER_TKIP
;
430 else if (alg
== WPA_ALG_CCMP
)
431 cipher
= IEEE80211_CIPHER_AES_CCM
;
433 printf("%s: unknown/unsupported algorithm %d\n",
438 if (key_len
> sizeof(wk
.ik_keydata
)) {
439 printf("%s: key length %d too big\n", __func__
, (int) key_len
);
443 memset(&wk
, 0, sizeof(wk
));
445 wk
.ik_flags
= IEEE80211_KEY_RECV
| IEEE80211_KEY_XMIT
;
447 memset(wk
.ik_macaddr
, 0xff, IEEE80211_ADDR_LEN
);
448 wk
.ik_keyix
= key_idx
;
449 wk
.ik_flags
|= IEEE80211_KEY_DEFAULT
;
451 memcpy(wk
.ik_macaddr
, addr
, IEEE80211_ADDR_LEN
);
452 wk
.ik_keyix
= IEEE80211_KEYIX_NONE
;
454 wk
.ik_keylen
= key_len
;
455 memcpy(wk
.ik_keydata
, key
, key_len
);
457 return set80211var(drv
, IEEE80211_IOC_WPAKEY
, &wk
, sizeof(wk
));
462 bsd_get_seqnum(const char *ifname
, void *priv
, const u8
*addr
, int idx
,
465 struct bsd_driver_data
*drv
= priv
;
466 struct ieee80211req_key wk
;
468 wpa_printf(MSG_DEBUG
, "%s: addr=%s idx=%d",
469 __func__
, ether_sprintf(addr
), idx
);
471 memset(&wk
, 0, sizeof(wk
));
473 memset(wk
.ik_macaddr
, 0xff, IEEE80211_ADDR_LEN
);
475 memcpy(wk
.ik_macaddr
, addr
, IEEE80211_ADDR_LEN
);
478 if (get80211var(drv
, IEEE80211_IOC_WPAKEY
, &wk
, sizeof(wk
)) < 0) {
479 printf("Failed to get encryption.\n");
483 #ifdef WORDS_BIGENDIAN
486 * wk.ik_keytsc is in host byte order (big endian), need to
487 * swap it to match with the byte order used in WPA.
490 u8 tmp
[WPA_KEY_RSC_LEN
];
491 memcpy(tmp
, &wk
.ik_keytsc
, sizeof(wk
.ik_keytsc
));
492 for (i
= 0; i
< WPA_KEY_RSC_LEN
; i
++) {
493 seq
[i
] = tmp
[WPA_KEY_RSC_LEN
- i
- 1];
496 #else /* WORDS_BIGENDIAN */
497 memcpy(seq
, &wk
.ik_keytsc
, sizeof(wk
.ik_keytsc
));
498 #endif /* WORDS_BIGENDIAN */
504 bsd_flush(void *priv
)
506 u8 allsta
[IEEE80211_ADDR_LEN
];
508 memset(allsta
, 0xff, IEEE80211_ADDR_LEN
);
509 return bsd_sta_deauth(priv
, NULL
, allsta
, IEEE80211_REASON_AUTH_LEAVE
);
514 bsd_read_sta_driver_data(void *priv
, struct hostap_sta_driver_data
*data
,
517 struct bsd_driver_data
*drv
= priv
;
518 struct ieee80211req_sta_stats stats
;
520 memcpy(stats
.is_u
.macaddr
, addr
, IEEE80211_ADDR_LEN
);
521 if (get80211var(drv
, IEEE80211_IOC_STA_STATS
, &stats
, sizeof(stats
)) > 0) {
522 /* XXX? do packets counts include non-data frames? */
523 data
->rx_packets
= stats
.is_stats
.ns_rx_data
;
524 data
->rx_bytes
= stats
.is_stats
.ns_rx_bytes
;
525 data
->tx_packets
= stats
.is_stats
.ns_tx_data
;
526 data
->tx_bytes
= stats
.is_stats
.ns_tx_bytes
;
532 bsd_set_opt_ie(const char *ifname
, void *priv
, const u8
*ie
, size_t ie_len
)
535 * Do nothing; we setup parameters at startup that define the
536 * contents of the beacon information element.
542 bsd_sta_deauth(void *priv
, const u8
*own_addr
, const u8
*addr
, int reason_code
)
544 struct bsd_driver_data
*drv
= priv
;
545 struct ieee80211req_mlme mlme
;
547 wpa_printf(MSG_DEBUG
, "%s: addr=%s reason_code=%d",
548 __func__
, ether_sprintf(addr
), reason_code
);
550 mlme
.im_op
= IEEE80211_MLME_DEAUTH
;
551 mlme
.im_reason
= reason_code
;
552 memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
553 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
557 bsd_sta_disassoc(void *priv
, const u8
*own_addr
, const u8
*addr
,
560 struct bsd_driver_data
*drv
= priv
;
561 struct ieee80211req_mlme mlme
;
563 wpa_printf(MSG_DEBUG
, "%s: addr=%s reason_code=%d",
564 __func__
, ether_sprintf(addr
), reason_code
);
566 mlme
.im_op
= IEEE80211_MLME_DISASSOC
;
567 mlme
.im_reason
= reason_code
;
568 memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
569 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
573 bsd_new_sta(struct bsd_driver_data
*drv
, u8 addr
[IEEE80211_ADDR_LEN
])
575 struct hostapd_data
*hapd
= drv
->hapd
;
576 struct ieee80211req_wpaie ie
;
581 * Fetch and validate any negotiated WPA/RSN parameters.
583 memset(&ie
, 0, sizeof(ie
));
584 memcpy(ie
.wpa_macaddr
, addr
, IEEE80211_ADDR_LEN
);
585 if (get80211var(drv
, IEEE80211_IOC_WPAIE
, &ie
, sizeof(ie
)) < 0) {
586 printf("Failed to get WPA/RSN information element.\n");
590 ielen
= ie
.wpa_ie
[1];
597 return hostapd_notif_assoc(hapd
, addr
, iebuf
, ielen
);
601 bsd_wireless_event_receive(int sock
, void *ctx
, void *sock_ctx
)
603 struct bsd_driver_data
*drv
= ctx
;
604 struct hostapd_data
*hapd
= drv
->hapd
;
606 struct if_announcemsghdr
*ifan
;
607 struct rt_msghdr
*rtm
;
608 struct ieee80211_michael_event
*mic
;
609 struct ieee80211_join_event
*join
;
610 struct ieee80211_leave_event
*leave
;
613 n
= read(sock
, buf
, sizeof(buf
));
615 if (errno
!= EINTR
&& errno
!= EAGAIN
)
616 perror("read(PF_ROUTE)");
620 rtm
= (struct rt_msghdr
*) buf
;
621 if (rtm
->rtm_version
!= RTM_VERSION
) {
622 wpa_printf(MSG_DEBUG
, "Routing message version %d not "
623 "understood\n", rtm
->rtm_version
);
626 ifan
= (struct if_announcemsghdr
*) rtm
;
627 switch (rtm
->rtm_type
) {
629 switch (ifan
->ifan_what
) {
630 case RTM_IEEE80211_ASSOC
:
631 case RTM_IEEE80211_REASSOC
:
632 case RTM_IEEE80211_DISASSOC
:
633 case RTM_IEEE80211_SCAN
:
635 case RTM_IEEE80211_LEAVE
:
636 leave
= (struct ieee80211_leave_event
*) &ifan
[1];
637 hostapd_notif_disassoc(drv
->hapd
, leave
->iev_addr
);
639 case RTM_IEEE80211_JOIN
:
640 #ifdef RTM_IEEE80211_REJOIN
641 case RTM_IEEE80211_REJOIN
:
643 join
= (struct ieee80211_join_event
*) &ifan
[1];
644 bsd_new_sta(drv
, join
->iev_addr
);
646 case RTM_IEEE80211_REPLAY
:
649 case RTM_IEEE80211_MICHAEL
:
650 mic
= (struct ieee80211_michael_event
*) &ifan
[1];
651 wpa_printf(MSG_DEBUG
,
652 "Michael MIC failure wireless event: "
653 "keyix=%u src_addr=" MACSTR
, mic
->iev_keyix
,
654 MAC2STR(mic
->iev_src
));
655 hostapd_michael_mic_failure(hapd
, mic
->iev_src
);
663 bsd_wireless_event_init(struct bsd_driver_data
*drv
)
669 s
= socket(PF_ROUTE
, SOCK_RAW
, 0);
671 perror("socket(PF_ROUTE,SOCK_RAW)");
674 eloop_register_read_sock(s
, bsd_wireless_event_receive
, drv
, NULL
);
681 bsd_wireless_event_deinit(struct bsd_driver_data
*drv
)
683 if (drv
->wext_sock
< 0)
685 eloop_unregister_read_sock(drv
->wext_sock
);
686 close(drv
->wext_sock
);
691 bsd_send_eapol(void *priv
, const u8
*addr
, const u8
*data
, size_t data_len
,
692 int encrypt
, const u8
*own_addr
)
694 struct bsd_driver_data
*drv
= priv
;
695 unsigned char buf
[3000];
696 unsigned char *bp
= buf
;
697 struct l2_ethhdr
*eth
;
702 * Prepend the Etherent header. If the caller left us
703 * space at the front we could just insert it but since
704 * we don't know we copy to a local buffer. Given the frequency
705 * and size of frames this probably doesn't matter.
707 len
= data_len
+ sizeof(struct l2_ethhdr
);
708 if (len
> sizeof(buf
)) {
711 printf("EAPOL frame discarded, cannot malloc temp "
712 "buffer of size %u!\n", (unsigned int) len
);
716 eth
= (struct l2_ethhdr
*) bp
;
717 memcpy(eth
->h_dest
, addr
, ETH_ALEN
);
718 memcpy(eth
->h_source
, own_addr
, ETH_ALEN
);
719 eth
->h_proto
= htons(ETH_P_EAPOL
);
720 memcpy(eth
+1, data
, data_len
);
722 wpa_hexdump(MSG_MSGDUMP
, "TX EAPOL", bp
, len
);
724 status
= l2_packet_send(drv
->sock_xmit
, addr
, ETH_P_EAPOL
, bp
, len
);
732 handle_read(void *ctx
, const u8
*src_addr
, const u8
*buf
, size_t len
)
734 struct bsd_driver_data
*drv
= ctx
;
735 hostapd_eapol_receive(drv
->hapd
, src_addr
,
736 buf
+ sizeof(struct l2_ethhdr
),
737 len
- sizeof(struct l2_ethhdr
));
741 hostapd_bsd_get_ssid(const char *ifname
, void *priv
, u8
*buf
, int len
)
743 struct bsd_driver_data
*drv
= priv
;
746 ssid_len
= bsd_get_ssid(drv
->ioctl_sock
, drv
->iface
, buf
);
747 wpa_printf(MSG_DEBUG
, "%s: ssid=\"%.*s\"", __func__
, ssid_len
, buf
);
753 hostapd_bsd_set_ssid(const char *ifname
, void *priv
, const u8
*buf
, int len
)
755 struct bsd_driver_data
*drv
= priv
;
757 wpa_printf(MSG_DEBUG
, "%s: ssid=\"%.*s\"", __func__
, len
, buf
);
759 return bsd_set_ssid(drv
->ioctl_sock
, drv
->iface
, buf
, len
);
763 bsd_init(struct hostapd_data
*hapd
, struct wpa_init_params
*params
)
765 struct bsd_driver_data
*drv
;
767 drv
= os_zalloc(sizeof(struct bsd_driver_data
));
769 printf("Could not allocate memory for bsd driver data\n");
774 drv
->ioctl_sock
= socket(PF_INET
, SOCK_DGRAM
, 0);
775 if (drv
->ioctl_sock
< 0) {
776 perror("socket[PF_INET,SOCK_DGRAM]");
779 memcpy(drv
->iface
, params
->ifname
, sizeof(drv
->iface
));
781 drv
->sock_xmit
= l2_packet_init(drv
->iface
, NULL
, ETH_P_EAPOL
,
782 handle_read
, drv
, 1);
783 if (drv
->sock_xmit
== NULL
)
785 if (l2_packet_get_own_addr(drv
->sock_xmit
, params
->own_addr
))
788 bsd_set_iface_flags(drv
, 0); /* mark down during setup */
789 if (bsd_wireless_event_init(drv
))
794 if (drv
->sock_xmit
!= NULL
)
795 l2_packet_deinit(drv
->sock_xmit
);
796 if (drv
->ioctl_sock
>= 0)
797 close(drv
->ioctl_sock
);
805 bsd_deinit(void *priv
)
807 struct bsd_driver_data
*drv
= priv
;
809 bsd_wireless_event_deinit(drv
);
810 (void) bsd_set_iface_flags(drv
, 0);
811 if (drv
->ioctl_sock
>= 0)
812 close(drv
->ioctl_sock
);
813 if (drv
->sock_xmit
!= NULL
)
814 l2_packet_deinit(drv
->sock_xmit
);
818 const struct wpa_driver_ops wpa_driver_bsd_ops
= {
820 .hapd_init
= bsd_init
,
821 .hapd_deinit
= bsd_deinit
,
822 .set_ieee8021x
= bsd_set_ieee8021x
,
823 .set_privacy
= bsd_set_privacy
,
824 .set_key
= bsd_set_key
,
825 .get_seqnum
= bsd_get_seqnum
,
827 .set_generic_elem
= bsd_set_opt_ie
,
828 .sta_set_flags
= bsd_sta_set_flags
,
829 .read_sta_data
= bsd_read_sta_driver_data
,
830 .hapd_send_eapol
= bsd_send_eapol
,
831 .sta_disassoc
= bsd_sta_disassoc
,
832 .sta_deauth
= bsd_sta_deauth
,
833 .hapd_set_ssid
= hostapd_bsd_set_ssid
,
834 .hapd_get_ssid
= hostapd_bsd_get_ssid
,
839 struct wpa_driver_bsd_data
{
840 int sock
; /* open socket for 802.11 ioctls */
841 int route
; /* routing socket for events */
842 char ifname
[IFNAMSIZ
+1]; /* interface name */
843 unsigned int ifindex
; /* interface index */
845 int prev_roaming
; /* roaming state to restore on deinit */
846 int prev_privacy
; /* privacy state to restore on deinit */
847 int prev_wpa
; /* wpa state to restore on deinit */
851 set80211var(struct wpa_driver_bsd_data
*drv
, int op
, const void *arg
, int arg_len
)
853 return bsd_set80211var(drv
->sock
, drv
->ifname
, op
, arg
, arg_len
);
857 get80211var(struct wpa_driver_bsd_data
*drv
, int op
, void *arg
, int arg_len
)
859 return bsd_get80211var(drv
->sock
, drv
->ifname
, op
, arg
, arg_len
);
863 set80211param(struct wpa_driver_bsd_data
*drv
, int op
, int arg
)
865 return bsd_set80211param(drv
->sock
, drv
->ifname
, op
, arg
);
869 get80211param(struct wpa_driver_bsd_data
*drv
, int op
)
871 struct ieee80211req ireq
;
873 os_memset(&ireq
, 0, sizeof(ireq
));
874 os_strlcpy(ireq
.i_name
, drv
->ifname
, sizeof(ireq
.i_name
));
877 if (ioctl(drv
->sock
, SIOCG80211
, &ireq
) < 0) {
878 fprintf(stderr
, "ioctl[SIOCG80211, op %u]: %s\n",
879 op
, strerror(errno
));
886 getifflags(struct wpa_driver_bsd_data
*drv
, int *flags
)
890 os_memset(&ifr
, 0, sizeof(ifr
));
891 os_strlcpy(ifr
.ifr_name
, drv
->ifname
, sizeof(ifr
.ifr_name
));
892 if (ioctl(drv
->sock
, SIOCGIFFLAGS
, (caddr_t
)&ifr
) < 0) {
893 perror("SIOCGIFFLAGS");
896 *flags
= ifr
.ifr_flags
& 0xffff;
901 setifflags(struct wpa_driver_bsd_data
*drv
, int flags
)
905 os_memset(&ifr
, 0, sizeof(ifr
));
906 os_strlcpy(ifr
.ifr_name
, drv
->ifname
, sizeof(ifr
.ifr_name
));
907 ifr
.ifr_flags
= flags
& 0xffff;
908 if (ioctl(drv
->sock
, SIOCSIFFLAGS
, (caddr_t
)&ifr
) < 0) {
909 perror("SIOCSIFFLAGS");
916 wpa_driver_bsd_get_bssid(void *priv
, u8
*bssid
)
918 struct wpa_driver_bsd_data
*drv
= priv
;
919 #ifdef SIOCG80211BSSID
920 struct ieee80211_bssid bs
;
922 os_strncpy(bs
.i_name
, drv
->ifname
, sizeof(bs
.i_name
));
923 if (ioctl(drv
->sock
, SIOCG80211BSSID
, &bs
) < 0)
925 os_memcpy(bssid
, bs
.i_bssid
, sizeof(bs
.i_bssid
));
928 return get80211var(drv
, IEEE80211_IOC_BSSID
,
929 bssid
, IEEE80211_ADDR_LEN
) < 0 ? -1 : 0;
935 wpa_driver_bsd_set_bssid(void *priv
, const char *bssid
)
937 struct wpa_driver_bsd_data
*drv
= priv
;
939 return set80211var(drv
, IEEE80211_IOC_BSSID
,
940 bssid
, IEEE80211_ADDR_LEN
);
945 wpa_driver_bsd_get_ssid(void *priv
, u8
*ssid
)
947 struct wpa_driver_bsd_data
*drv
= priv
;
949 return bsd_get_ssid(drv
->sock
, drv
->ifname
, ssid
);
953 wpa_driver_bsd_set_ssid(void *priv
, const u8
*ssid
,
956 struct wpa_driver_bsd_data
*drv
= priv
;
958 return bsd_set_ssid(drv
->sock
, drv
->ifname
, ssid
, ssid_len
);
962 wpa_driver_bsd_set_wpa_ie(struct wpa_driver_bsd_data
*drv
,
963 const u8
*wpa_ie
, size_t wpa_ie_len
)
965 return set80211var(drv
, IEEE80211_IOC_OPTIE
, wpa_ie
, wpa_ie_len
);
969 wpa_driver_bsd_set_wpa_internal(void *priv
, int wpa
, int privacy
)
971 struct wpa_driver_bsd_data
*drv
= priv
;
974 wpa_printf(MSG_DEBUG
, "%s: wpa=%d privacy=%d",
975 __FUNCTION__
, wpa
, privacy
);
977 if (!wpa
&& wpa_driver_bsd_set_wpa_ie(drv
, NULL
, 0) < 0)
979 if (set80211param(drv
, IEEE80211_IOC_PRIVACY
, privacy
) < 0)
981 if (set80211param(drv
, IEEE80211_IOC_WPA
, wpa
) < 0)
988 wpa_driver_bsd_set_wpa(void *priv
, int enabled
)
990 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __FUNCTION__
, enabled
);
992 return wpa_driver_bsd_set_wpa_internal(priv
, enabled
? 3 : 0, enabled
);
996 wpa_driver_bsd_del_key(struct wpa_driver_bsd_data
*drv
, int key_idx
,
997 const unsigned char *addr
)
999 struct ieee80211req_del_key wk
;
1001 os_memset(&wk
, 0, sizeof(wk
));
1003 bcmp(addr
, "\xff\xff\xff\xff\xff\xff", IEEE80211_ADDR_LEN
) != 0) {
1004 struct ether_addr ea
;
1006 os_memcpy(&ea
, addr
, IEEE80211_ADDR_LEN
);
1007 wpa_printf(MSG_DEBUG
, "%s: addr=%s keyidx=%d",
1008 __func__
, ether_ntoa(&ea
), key_idx
);
1009 os_memcpy(wk
.idk_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1010 wk
.idk_keyix
= (uint8_t) IEEE80211_KEYIX_NONE
;
1012 wpa_printf(MSG_DEBUG
, "%s: keyidx=%d", __func__
, key_idx
);
1013 wk
.idk_keyix
= key_idx
;
1015 return set80211var(drv
, IEEE80211_IOC_DELKEY
, &wk
, sizeof(wk
));
1019 wpa_driver_bsd_set_key(const char *ifname
, void *priv
, wpa_alg alg
,
1020 const unsigned char *addr
, int key_idx
, int set_tx
,
1021 const u8
*seq
, size_t seq_len
,
1022 const u8
*key
, size_t key_len
)
1024 struct wpa_driver_bsd_data
*drv
= priv
;
1025 struct ieee80211req_key wk
;
1026 struct ether_addr ea
;
1030 if (alg
== WPA_ALG_NONE
)
1031 return wpa_driver_bsd_del_key(drv
, key_idx
, addr
);
1036 cipher
= IEEE80211_CIPHER_WEP
;
1040 cipher
= IEEE80211_CIPHER_TKIP
;
1044 cipher
= IEEE80211_CIPHER_AES_CCM
;
1047 wpa_printf(MSG_DEBUG
, "%s: unknown/unsupported algorithm %d",
1052 os_memcpy(&ea
, addr
, IEEE80211_ADDR_LEN
);
1053 wpa_printf(MSG_DEBUG
,
1054 "%s: alg=%s addr=%s key_idx=%d set_tx=%d seq_len=%zu key_len=%zu",
1055 __func__
, alg_name
, ether_ntoa(&ea
), key_idx
, set_tx
,
1058 if (seq_len
> sizeof(u_int64_t
)) {
1059 wpa_printf(MSG_DEBUG
, "%s: seq_len %zu too big",
1063 if (key_len
> sizeof(wk
.ik_keydata
)) {
1064 wpa_printf(MSG_DEBUG
, "%s: key length %zu too big",
1069 os_memset(&wk
, 0, sizeof(wk
));
1070 wk
.ik_type
= cipher
;
1071 wk
.ik_flags
= IEEE80211_KEY_RECV
;
1073 wk
.ik_flags
|= IEEE80211_KEY_XMIT
;
1074 os_memcpy(wk
.ik_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1076 * Deduce whether group/global or unicast key by checking
1077 * the address (yech). Note also that we can only mark global
1078 * keys default; doing this for a unicast key is an error.
1080 if (bcmp(addr
, "\xff\xff\xff\xff\xff\xff", IEEE80211_ADDR_LEN
) == 0) {
1081 wk
.ik_flags
|= IEEE80211_KEY_GROUP
;
1082 wk
.ik_keyix
= key_idx
;
1084 wk
.ik_keyix
= (key_idx
== 0 ? IEEE80211_KEYIX_NONE
: key_idx
);
1086 if (wk
.ik_keyix
!= IEEE80211_KEYIX_NONE
&& set_tx
)
1087 wk
.ik_flags
|= IEEE80211_KEY_DEFAULT
;
1088 wk
.ik_keylen
= key_len
;
1089 os_memcpy(&wk
.ik_keyrsc
, seq
, seq_len
);
1090 os_memcpy(wk
.ik_keydata
, key
, key_len
);
1092 return set80211var(drv
, IEEE80211_IOC_WPAKEY
, &wk
, sizeof(wk
));
1096 wpa_driver_bsd_set_countermeasures(void *priv
, int enabled
)
1098 struct wpa_driver_bsd_data
*drv
= priv
;
1100 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
1101 return set80211param(drv
, IEEE80211_IOC_COUNTERMEASURES
, enabled
);
1106 wpa_driver_bsd_set_drop_unencrypted(void *priv
, int enabled
)
1108 struct wpa_driver_bsd_data
*drv
= priv
;
1110 wpa_printf(MSG_DEBUG
, "%s: enabled=%d", __func__
, enabled
);
1111 return set80211param(drv
, IEEE80211_IOC_DROPUNENCRYPTED
, enabled
);
1115 wpa_driver_bsd_deauthenticate(void *priv
, const u8
*addr
, int reason_code
)
1117 struct wpa_driver_bsd_data
*drv
= priv
;
1118 struct ieee80211req_mlme mlme
;
1120 wpa_printf(MSG_DEBUG
, "%s", __func__
);
1121 os_memset(&mlme
, 0, sizeof(mlme
));
1122 mlme
.im_op
= IEEE80211_MLME_DEAUTH
;
1123 mlme
.im_reason
= reason_code
;
1124 os_memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1125 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
1129 wpa_driver_bsd_disassociate(void *priv
, const u8
*addr
, int reason_code
)
1131 struct wpa_driver_bsd_data
*drv
= priv
;
1132 struct ieee80211req_mlme mlme
;
1134 wpa_printf(MSG_DEBUG
, "%s", __func__
);
1135 os_memset(&mlme
, 0, sizeof(mlme
));
1136 mlme
.im_op
= IEEE80211_MLME_DISASSOC
;
1137 mlme
.im_reason
= reason_code
;
1138 os_memcpy(mlme
.im_macaddr
, addr
, IEEE80211_ADDR_LEN
);
1139 return set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
));
1143 wpa_driver_bsd_set_auth_alg(void *priv
, int auth_alg
)
1145 struct wpa_driver_bsd_data
*drv
= priv
;
1148 if ((auth_alg
& AUTH_ALG_OPEN_SYSTEM
) &&
1149 (auth_alg
& AUTH_ALG_SHARED_KEY
))
1150 authmode
= IEEE80211_AUTH_AUTO
;
1151 else if (auth_alg
& AUTH_ALG_SHARED_KEY
)
1152 authmode
= IEEE80211_AUTH_SHARED
;
1154 authmode
= IEEE80211_AUTH_OPEN
;
1156 return set80211param(drv
, IEEE80211_IOC_AUTHMODE
, authmode
);
1160 wpa_driver_bsd_associate(void *priv
, struct wpa_driver_associate_params
*params
)
1162 struct wpa_driver_bsd_data
*drv
= priv
;
1163 struct ieee80211req_mlme mlme
;
1167 wpa_printf(MSG_DEBUG
,
1168 "%s: ssid '%.*s' wpa ie len %u pairwise %u group %u key mgmt %u"
1170 , (unsigned int) params
->ssid_len
, params
->ssid
1171 , (unsigned int) params
->wpa_ie_len
1172 , params
->pairwise_suite
1173 , params
->group_suite
1174 , params
->key_mgmt_suite
1177 if (wpa_driver_bsd_set_drop_unencrypted(drv
, params
->drop_unencrypted
)
1180 if (wpa_driver_bsd_set_auth_alg(drv
, params
->auth_alg
) < 0)
1182 /* XXX error handling is wrong but unclear what to do... */
1183 if (wpa_driver_bsd_set_wpa_ie(drv
, params
->wpa_ie
, params
->wpa_ie_len
) < 0)
1186 privacy
= !(params
->pairwise_suite
== CIPHER_NONE
&&
1187 params
->group_suite
== CIPHER_NONE
&&
1188 params
->key_mgmt_suite
== KEY_MGMT_NONE
&&
1189 params
->wpa_ie_len
== 0);
1190 wpa_printf(MSG_DEBUG
, "%s: set PRIVACY %u", __func__
, privacy
);
1192 if (set80211param(drv
, IEEE80211_IOC_PRIVACY
, privacy
) < 0)
1195 if (params
->wpa_ie_len
&&
1196 set80211param(drv
, IEEE80211_IOC_WPA
,
1197 params
->wpa_ie
[0] == WLAN_EID_RSN
? 2 : 1) < 0)
1200 os_memset(&mlme
, 0, sizeof(mlme
));
1201 mlme
.im_op
= IEEE80211_MLME_ASSOC
;
1202 if (params
->ssid
!= NULL
)
1203 os_memcpy(mlme
.im_ssid
, params
->ssid
, params
->ssid_len
);
1204 mlme
.im_ssid_len
= params
->ssid_len
;
1205 if (params
->bssid
!= NULL
)
1206 os_memcpy(mlme
.im_macaddr
, params
->bssid
, IEEE80211_ADDR_LEN
);
1207 if (set80211var(drv
, IEEE80211_IOC_MLME
, &mlme
, sizeof(mlme
)) < 0)
1213 wpa_driver_bsd_scan(void *priv
, struct wpa_driver_scan_params
*params
)
1215 struct wpa_driver_bsd_data
*drv
= priv
;
1217 const u8
*ssid
= params
->ssids
[0].ssid
;
1218 size_t ssid_len
= params
->ssids
[0].ssid_len
;
1220 /* NB: interface must be marked UP to do a scan */
1221 if (getifflags(drv
, &flags
) != 0 || setifflags(drv
, flags
| IFF_UP
) != 0)
1224 /* set desired ssid before scan */
1225 if (wpa_driver_bsd_set_ssid(drv
, ssid
, ssid_len
) < 0)
1228 /* NB: net80211 delivers a scan complete event so no need to poll */
1229 return set80211param(drv
, IEEE80211_IOC_SCAN_REQ
, 0);
1233 wpa_driver_bsd_event_receive(int sock
, void *ctx
, void *sock_ctx
)
1235 struct wpa_driver_bsd_data
*drv
= sock_ctx
;
1237 struct if_announcemsghdr
*ifan
;
1238 struct if_msghdr
*ifm
;
1239 struct rt_msghdr
*rtm
;
1240 union wpa_event_data event
;
1241 struct ieee80211_michael_event
*mic
;
1244 n
= read(sock
, buf
, sizeof(buf
));
1246 if (errno
!= EINTR
&& errno
!= EAGAIN
)
1247 perror("read(PF_ROUTE)");
1251 rtm
= (struct rt_msghdr
*) buf
;
1252 if (rtm
->rtm_version
!= RTM_VERSION
) {
1253 wpa_printf(MSG_DEBUG
, "Routing message version %d not "
1254 "understood\n", rtm
->rtm_version
);
1257 os_memset(&event
, 0, sizeof(event
));
1258 switch (rtm
->rtm_type
) {
1259 case RTM_IFANNOUNCE
:
1260 ifan
= (struct if_announcemsghdr
*) rtm
;
1261 if (ifan
->ifan_index
!= drv
->ifindex
)
1263 strlcpy(event
.interface_status
.ifname
, drv
->ifname
,
1264 sizeof(event
.interface_status
.ifname
));
1265 switch (ifan
->ifan_what
) {
1266 case IFAN_DEPARTURE
:
1267 event
.interface_status
.ievent
= EVENT_INTERFACE_REMOVED
;
1271 wpa_printf(MSG_DEBUG
, "RTM_IFANNOUNCE: Interface '%s' %s",
1272 event
.interface_status
.ifname
,
1273 ifan
->ifan_what
== IFAN_DEPARTURE
?
1274 "removed" : "added");
1275 wpa_supplicant_event(ctx
, EVENT_INTERFACE_STATUS
, &event
);
1278 ifan
= (struct if_announcemsghdr
*) rtm
;
1279 if (ifan
->ifan_index
!= drv
->ifindex
)
1281 switch (ifan
->ifan_what
) {
1282 case RTM_IEEE80211_ASSOC
:
1283 case RTM_IEEE80211_REASSOC
:
1284 wpa_supplicant_event(ctx
, EVENT_ASSOC
, NULL
);
1286 case RTM_IEEE80211_DISASSOC
:
1287 wpa_supplicant_event(ctx
, EVENT_DISASSOC
, NULL
);
1289 case RTM_IEEE80211_SCAN
:
1290 wpa_supplicant_event(ctx
, EVENT_SCAN_RESULTS
, NULL
);
1292 case RTM_IEEE80211_REPLAY
:
1295 case RTM_IEEE80211_MICHAEL
:
1296 mic
= (struct ieee80211_michael_event
*) &ifan
[1];
1297 wpa_printf(MSG_DEBUG
,
1298 "Michael MIC failure wireless event: "
1299 "keyix=%u src_addr=" MACSTR
, mic
->iev_keyix
,
1300 MAC2STR(mic
->iev_src
));
1302 os_memset(&event
, 0, sizeof(event
));
1303 event
.michael_mic_failure
.unicast
=
1304 !IEEE80211_IS_MULTICAST(mic
->iev_dst
);
1305 wpa_supplicant_event(ctx
, EVENT_MICHAEL_MIC_FAILURE
,
1311 ifm
= (struct if_msghdr
*) rtm
;
1312 if (ifm
->ifm_index
!= drv
->ifindex
)
1314 if ((rtm
->rtm_flags
& RTF_UP
) == 0) {
1315 strlcpy(event
.interface_status
.ifname
, drv
->ifname
,
1316 sizeof(event
.interface_status
.ifname
));
1317 event
.interface_status
.ievent
= EVENT_INTERFACE_REMOVED
;
1318 wpa_printf(MSG_DEBUG
, "RTM_IFINFO: Interface '%s' DOWN",
1319 event
.interface_status
.ifname
);
1320 wpa_supplicant_event(ctx
, EVENT_INTERFACE_STATUS
, &event
);
1327 wpa_driver_bsd_add_scan_entry(struct wpa_scan_results
*res
,
1328 struct ieee80211req_scan_result
*sr
)
1330 struct wpa_scan_res
*result
, **tmp
;
1334 extra_len
= 2 + sr
->isr_ssid_len
;
1335 extra_len
+= 2 + sr
->isr_nrates
;
1336 extra_len
+= 3; /* ERP IE */
1337 extra_len
+= sr
->isr_ie_len
;
1339 result
= os_zalloc(sizeof(*result
) + extra_len
);
1342 os_memcpy(result
->bssid
, sr
->isr_bssid
, ETH_ALEN
);
1343 result
->freq
= sr
->isr_freq
;
1344 result
->beacon_int
= sr
->isr_intval
;
1345 result
->caps
= sr
->isr_capinfo
;
1346 result
->qual
= sr
->isr_rssi
;
1347 result
->noise
= sr
->isr_noise
;
1349 pos
= (u8
*)(result
+ 1);
1351 *pos
++ = WLAN_EID_SSID
;
1352 *pos
++ = sr
->isr_ssid_len
;
1353 os_memcpy(pos
, sr
+ 1, sr
->isr_ssid_len
);
1354 pos
+= sr
->isr_ssid_len
;
1357 * Deal all rates as supported rate.
1358 * Because net80211 doesn't report extended supported rate or not.
1360 *pos
++ = WLAN_EID_SUPP_RATES
;
1361 *pos
++ = sr
->isr_nrates
;
1362 os_memcpy(pos
, sr
->isr_rates
, sr
->isr_nrates
);
1363 pos
+= sr
->isr_nrates
;
1365 *pos
++ = WLAN_EID_ERP_INFO
;
1367 *pos
++ = sr
->isr_erp
;
1369 os_memcpy(pos
, (u8
*)(sr
+ 1) + sr
->isr_ssid_len
, sr
->isr_ie_len
);
1370 pos
+= sr
->isr_ie_len
;
1372 result
->ie_len
= pos
- (u8
*)(result
+ 1);
1374 tmp
= os_realloc(res
->res
,
1375 (res
->num
+ 1) * sizeof(struct wpa_scan_res
*));
1380 tmp
[res
->num
++] = result
;
1384 struct wpa_scan_results
*
1385 wpa_driver_bsd_get_scan_results2(void *priv
)
1387 struct wpa_driver_bsd_data
*drv
= priv
;
1388 struct ieee80211req_scan_result
*sr
;
1389 struct wpa_scan_results
*res
;
1391 uint8_t buf
[24*1024], *pos
;
1393 len
= get80211var(drv
, IEEE80211_IOC_SCAN_RESULTS
, buf
, 24*1024);
1397 res
= os_zalloc(sizeof(*res
));
1403 while (rest
>= sizeof(struct ieee80211req_scan_result
)) {
1404 sr
= (struct ieee80211req_scan_result
*)pos
;
1405 wpa_driver_bsd_add_scan_entry(res
, sr
);
1407 rest
-= sr
->isr_len
;
1410 wpa_printf(MSG_DEBUG
, "Received %d bytes of scan results (%lu BSSes)",
1411 len
, (unsigned long)res
->num
);
1417 wpa_driver_bsd_init(void *ctx
, const char *ifname
)
1419 #define GETPARAM(drv, param, v) \
1420 (((v) = get80211param(drv, param)) != -1)
1421 struct wpa_driver_bsd_data
*drv
;
1423 drv
= os_zalloc(sizeof(*drv
));
1427 * NB: We require the interface name be mappable to an index.
1428 * This implies we do not support having wpa_supplicant
1429 * wait for an interface to appear. This seems ok; that
1430 * doesn't belong here; it's really the job of devd.
1432 drv
->ifindex
= if_nametoindex(ifname
);
1433 if (drv
->ifindex
== 0) {
1434 wpa_printf(MSG_DEBUG
, "%s: interface %s does not exist",
1438 drv
->sock
= socket(PF_INET
, SOCK_DGRAM
, 0);
1441 drv
->route
= socket(PF_ROUTE
, SOCK_RAW
, 0);
1444 eloop_register_read_sock(drv
->route
,
1445 wpa_driver_bsd_event_receive
, ctx
, drv
);
1448 os_strlcpy(drv
->ifname
, ifname
, sizeof(drv
->ifname
));
1450 if (!GETPARAM(drv
, IEEE80211_IOC_ROAMING
, drv
->prev_roaming
)) {
1451 wpa_printf(MSG_DEBUG
, "%s: failed to get roaming state: %s",
1452 __func__
, strerror(errno
));
1455 if (!GETPARAM(drv
, IEEE80211_IOC_PRIVACY
, drv
->prev_privacy
)) {
1456 wpa_printf(MSG_DEBUG
, "%s: failed to get privacy state: %s",
1457 __func__
, strerror(errno
));
1460 if (!GETPARAM(drv
, IEEE80211_IOC_WPA
, drv
->prev_wpa
)) {
1461 wpa_printf(MSG_DEBUG
, "%s: failed to get wpa state: %s",
1462 __func__
, strerror(errno
));
1465 if (set80211param(drv
, IEEE80211_IOC_ROAMING
, IEEE80211_ROAMING_MANUAL
) < 0) {
1466 wpa_printf(MSG_DEBUG
, "%s: failed to set wpa_supplicant-based "
1467 "roaming: %s", __func__
, strerror(errno
));
1471 if (set80211param(drv
, IEEE80211_IOC_WPA
, 1+2) < 0) {
1472 wpa_printf(MSG_DEBUG
, "%s: failed to enable WPA support %s",
1473 __func__
, strerror(errno
));
1477 wpa_driver_bsd_set_wpa(drv
, 1);
1489 wpa_driver_bsd_deinit(void *priv
)
1491 struct wpa_driver_bsd_data
*drv
= priv
;
1494 wpa_driver_bsd_set_wpa(drv
, 0);
1495 eloop_unregister_read_sock(drv
->route
);
1497 /* NB: mark interface down */
1498 if (getifflags(drv
, &flags
) == 0)
1499 (void) setifflags(drv
, flags
&~ IFF_UP
);
1501 wpa_driver_bsd_set_wpa_internal(drv
, drv
->prev_wpa
, drv
->prev_privacy
);
1502 if (set80211param(drv
, IEEE80211_IOC_ROAMING
, drv
->prev_roaming
) < 0)
1503 wpa_printf(MSG_DEBUG
, "%s: failed to restore roaming state",
1506 (void) close(drv
->route
); /* ioctl socket */
1507 (void) close(drv
->sock
); /* event socket */
1512 const struct wpa_driver_ops wpa_driver_bsd_ops
= {
1514 .desc
= "BSD 802.11 support",
1515 .init
= wpa_driver_bsd_init
,
1516 .deinit
= wpa_driver_bsd_deinit
,
1517 .get_bssid
= wpa_driver_bsd_get_bssid
,
1518 .get_ssid
= wpa_driver_bsd_get_ssid
,
1519 .set_key
= wpa_driver_bsd_set_key
,
1520 .set_countermeasures
= wpa_driver_bsd_set_countermeasures
,
1521 .scan2
= wpa_driver_bsd_scan
,
1522 .get_scan_results2
= wpa_driver_bsd_get_scan_results2
,
1523 .deauthenticate
= wpa_driver_bsd_deauthenticate
,
1524 .disassociate
= wpa_driver_bsd_disassociate
,
1525 .associate
= wpa_driver_bsd_associate
,
1528 #endif /* HOSTAPD */