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"
25 #include <net/if_media.h>
28 #include <net/if_ether.h>
30 #include <net/ethernet.h>
32 #include <net/route.h>
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__ */
43 #include <net80211/ieee80211_freebsd.h>
46 #include <net80211/ieee80211_netbsd.h>
49 #include "l2_packet/l2_packet.h"
51 struct bsd_driver_data {
52 struct hostapd_data *hapd; /* back pointer */
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 */
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 */
67 /* Generic functions for hostapd and wpa_supplicant */
70 bsd_set80211var(int s, const char *ifname, int op, const 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));
78 ireq.i_data = (void *) arg;
80 if (ioctl(s, SIOCS80211, &ireq) < 0) {
81 fprintf(stderr, "ioctl[SIOCS80211, op %u, len %u]: %s\n",
82 op, arg_len, strerror(errno));
89 bsd_get80211var(int s, const char *ifname, int op, void *arg, int arg_len)
91 struct ieee80211req ireq;
93 os_memset(&ireq, 0, sizeof(ireq));
94 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
99 if (ioctl(s, SIOCG80211, &ireq) < 0) {
100 fprintf(stderr, "ioctl[SIOCG80211, op %u, len %u]: %s\n",
101 op, arg_len, strerror(errno));
108 bsd_set80211param(int s, const char *ifname, int op, int arg)
110 struct ieee80211req ireq;
112 os_memset(&ireq, 0, sizeof(ireq));
113 os_strlcpy(ireq.i_name, ifname, sizeof(ireq.i_name));
117 if (ioctl(s, SIOCS80211, &ireq) < 0) {
118 fprintf(stderr, "ioctl[SIOCS80211, op %u, arg 0x%x]: %s\n",
119 op, arg, strerror(errno));
126 get80211var(struct bsd_driver_data *drv, int op, void *arg, int arg_len)
128 return bsd_get80211var(drv->sock, drv->ifname, op, arg, arg_len);
132 set80211var(struct bsd_driver_data *drv, int op, const void *arg, int arg_len)
134 return bsd_set80211var(drv->sock, drv->ifname, op, arg, arg_len);
138 set80211param(struct bsd_driver_data *drv, int op, int arg)
140 return bsd_set80211param(drv->sock, drv->ifname, op, arg);
144 bsd_get_ssid(const char *ifname, void *priv, u8 *ssid, int len)
146 struct bsd_driver_data *drv = priv;
147 #ifdef SIOCG80211NWID
148 struct ieee80211_nwid nwid;
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)
157 os_memcpy(ssid, nwid.i_nwid, nwid.i_len);
160 return get80211var(drv, IEEE80211_IOC_SSID, ssid, IEEE80211_NWID_LEN);
165 bsd_set_ssid(const char *ifname, void *priv, const u8 *ssid, int ssid_len)
167 struct bsd_driver_data *drv = priv;
168 #ifdef SIOCS80211NWID
169 struct ieee80211_nwid nwid;
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);
179 return set80211var(drv, IEEE80211_IOC_SSID, ssid, ssid_len);
184 bsd_get_if_media(void *priv)
186 struct bsd_driver_data *drv = priv;
187 struct ifmediareq ifmr;
189 os_memset(&ifmr, 0, sizeof(ifmr));
190 os_strlcpy(ifmr.ifm_name, drv->ifname, sizeof(ifmr.ifm_name));
192 if (ioctl(drv->sock, SIOCGIFMEDIA, &ifmr) < 0) {
193 wpa_printf(MSG_ERROR, "%s: SIOCGIFMEDIA %s", __func__,
198 return ifmr.ifm_current;
202 bsd_set_if_media(void *priv, int media)
204 struct bsd_driver_data *drv = priv;
207 os_memset(&ifr, 0, sizeof(ifr));
208 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
209 ifr.ifr_media = media;
211 if (ioctl(drv->sock, SIOCSIFMEDIA, &ifr) < 0) {
212 wpa_printf(MSG_ERROR, "%s: SIOCSIFMEDIA %s", __func__,
221 bsd_set_mediaopt(void *priv, uint32_t mask, uint32_t mode)
223 int media = bsd_get_if_media(priv);
229 if (bsd_set_if_media(priv, media) < 0)
235 bsd_del_key(void *priv, const u8 *addr, int key_idx)
237 struct ieee80211req_del_key wk;
239 os_memset(&wk, 0, sizeof(wk));
241 wpa_printf(MSG_DEBUG, "%s: key_idx=%d", __func__, key_idx);
242 wk.idk_keyix = key_idx;
244 wpa_printf(MSG_DEBUG, "%s: addr=" MACSTR, __func__,
246 os_memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN);
247 wk.idk_keyix = (u_int8_t) IEEE80211_KEYIX_NONE; /* XXX */
250 return set80211var(priv, IEEE80211_IOC_DELKEY, &wk, sizeof(wk));
254 bsd_send_mlme_param(void *priv, const u8 op, const u16 reason, const u8 *addr)
256 struct ieee80211req_mlme mlme;
258 os_memset(&mlme, 0, sizeof(mlme));
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));
266 bsd_ctrl_iface(void *priv, int enable)
268 struct bsd_driver_data *drv = priv;
271 os_memset(&ifr, 0, sizeof(ifr));
272 os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
274 if (ioctl(drv->sock, SIOCGIFFLAGS, &ifr) < 0) {
275 perror("ioctl[SIOCGIFFLAGS]");
280 ifr.ifr_flags |= IFF_UP;
282 ifr.ifr_flags &= ~IFF_UP;
284 if (ioctl(drv->sock, SIOCSIFFLAGS, &ifr) < 0) {
285 perror("ioctl[SIOCSIFFLAGS]");
293 bsd_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)
297 struct ieee80211req_key wk;
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);
303 if (alg == WPA_ALG_NONE) {
306 os_memcmp(addr, "\xff\xff\xff\xff\xff\xff",
307 IEEE80211_ADDR_LEN) == 0)
308 return bsd_del_key(priv, NULL, key_idx);
311 return bsd_del_key(priv, addr, key_idx);
314 os_memset(&wk, 0, sizeof(wk));
317 wk.ik_type = IEEE80211_CIPHER_WEP;
320 wk.ik_type = IEEE80211_CIPHER_TKIP;
323 wk.ik_type = IEEE80211_CIPHER_AES_CCM;
326 wpa_printf(MSG_ERROR, "%s: unknown alg=%d", __func__, alg);
330 wk.ik_flags = IEEE80211_KEY_RECV;
332 wk.ik_flags |= IEEE80211_KEY_XMIT;
335 os_memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
336 wk.ik_keyix = key_idx;
338 os_memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
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.
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;
349 wk.ik_keyix = key_idx == 0 ? IEEE80211_KEYIX_NONE :
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);
359 return set80211var(priv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk));
363 bsd_configure_wpa(void *priv, struct wpa_bss_params *params)
365 static const char *ciphernames[] =
366 { "WEP", "TKIP", "AES-OCB", "AES-CCM", "CKIP", "NONE" };
369 switch (params->wpa_group) {
370 case WPA_CIPHER_CCMP:
371 v = IEEE80211_CIPHER_AES_CCM;
373 case WPA_CIPHER_TKIP:
374 v = IEEE80211_CIPHER_TKIP;
376 case WPA_CIPHER_WEP104:
377 v = IEEE80211_CIPHER_WEP;
379 case WPA_CIPHER_WEP40:
380 v = IEEE80211_CIPHER_WEP;
382 case WPA_CIPHER_NONE:
383 v = IEEE80211_CIPHER_NONE;
386 printf("Unknown group key cipher %u\n",
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",
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);
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);
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);
429 if (params->rsn_preauth)
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);
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);
447 bsd_set_ieee8021x(void *priv, struct wpa_bss_params *params)
449 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled);
451 if (!params->enabled) {
452 /* XXX restore state */
453 return set80211param(priv, IEEE80211_IOC_AUTHMODE,
454 IEEE80211_AUTH_AUTO);
456 if (!params->wpa && !params->ieee802_1x) {
457 wpa_printf(MSG_ERROR, "%s: No 802.1X or WPA enabled",
461 if (params->wpa && bsd_configure_wpa(priv, params) != 0) {
462 wpa_printf(MSG_ERROR, "%s: Failed to configure WPA state",
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",
472 return bsd_ctrl_iface(priv, 1);
476 bsd_set_sta_authorized(void *priv, const u8 *addr, int total_flags,
477 int flags_or, int flags_and)
481 /* For now, only support setting Authorized flag */
482 if (flags_or & WPA_STA_AUTHORIZED)
484 if (!(flags_and & WPA_STA_AUTHORIZED))
490 return bsd_send_mlme_param(priv, authorized ?
491 IEEE80211_MLME_AUTHORIZE :
492 IEEE80211_MLME_UNAUTHORIZE, 0, addr);
496 bsd_new_sta(void *priv, void *ctx, u8 addr[IEEE80211_ADDR_LEN])
498 struct ieee80211req_wpaie ie;
503 * Fetch and validate any negotiated WPA/RSN parameters.
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");
512 ielen = ie.wpa_ie[1];
519 drv_event_assoc(ctx, addr, iebuf, ielen);
523 bsd_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len,
524 int encrypt, const u8 *own_addr)
526 struct bsd_driver_data *drv = priv;
528 wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", data, data_len);
530 return l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, data,
535 bsd_set_freq(void *priv, u16 channel)
537 struct bsd_driver_data *drv = priv;
538 #ifdef SIOCS80211CHANNEL
539 struct ieee80211chanreq creq;
540 #endif /* SIOCS80211CHANNEL */
544 mode = IFM_IEEE80211_11G;
545 else if (channel == 14)
546 mode = IFM_IEEE80211_11B;
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",
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 */
569 * Avoid conflicts with hostapd definitions by undefining couple of defines
570 * from net80211 header files.
576 static int bsd_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr,
580 ether_sprintf(const u8 *addr)
582 static char buf[sizeof(MACSTR)];
585 snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr));
587 snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0);
592 bsd_set_privacy(const char *ifname, void *priv, int enabled)
594 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
596 return set80211param(priv, IEEE80211_IOC_PRIVACY, enabled);
600 bsd_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx,
603 struct ieee80211req_key wk;
605 wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d",
606 __func__, ether_sprintf(addr), idx);
608 memset(&wk, 0, sizeof(wk));
610 memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
612 memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
615 if (get80211var(priv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk)) < 0) {
616 printf("Failed to get encryption.\n");
620 #ifdef WORDS_BIGENDIAN
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.
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];
633 #else /* WORDS_BIGENDIAN */
634 memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
635 #endif /* WORDS_BIGENDIAN */
641 bsd_flush(void *priv)
643 u8 allsta[IEEE80211_ADDR_LEN];
645 memset(allsta, 0xff, IEEE80211_ADDR_LEN);
646 return bsd_sta_deauth(priv, NULL, allsta, IEEE80211_REASON_AUTH_LEAVE);
651 bsd_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data,
654 struct ieee80211req_sta_stats stats;
656 memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN);
657 if (get80211var(priv, IEEE80211_IOC_STA_STATS, &stats, sizeof(stats))
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;
669 bsd_set_opt_ie(const char *ifname, void *priv, const u8 *ie, size_t ie_len)
672 * Do nothing; we setup parameters at startup that define the
673 * contents of the beacon information element.
679 bsd_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, int reason_code)
681 return bsd_send_mlme_param(priv, IEEE80211_MLME_DEAUTH, reason_code,
686 bsd_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr,
689 return bsd_send_mlme_param(priv, IEEE80211_MLME_DISASSOC, reason_code,
694 bsd_wireless_event_receive(int sock, void *ctx, void *sock_ctx)
696 struct bsd_driver_data *drv = ctx;
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;
704 union wpa_event_data data;
706 n = read(sock, buf, sizeof(buf));
708 if (errno != EINTR && errno != EAGAIN)
709 perror("read(PF_ROUTE)");
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);
719 ifan = (struct if_announcemsghdr *) rtm;
720 switch (rtm->rtm_type) {
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:
728 case RTM_IEEE80211_LEAVE:
729 leave = (struct ieee80211_leave_event *) &ifan[1];
730 drv_event_disassoc(drv->hapd, leave->iev_addr);
732 case RTM_IEEE80211_JOIN:
733 #ifdef RTM_IEEE80211_REJOIN
734 case RTM_IEEE80211_REJOIN:
736 join = (struct ieee80211_join_event *) &ifan[1];
737 bsd_new_sta(drv, drv->hapd, join->iev_addr);
739 case RTM_IEEE80211_REPLAY:
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);
760 handle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
762 struct bsd_driver_data *drv = ctx;
763 drv_event_eapol_rx(drv->hapd, src_addr, buf, len);
767 hostapd_bsd_set_freq(void *priv, struct hostapd_freq_params *freq)
769 return bsd_set_freq(priv, freq->channel);
773 bsd_init(struct hostapd_data *hapd, struct wpa_init_params *params)
775 struct bsd_driver_data *drv;
777 drv = os_zalloc(sizeof(struct bsd_driver_data));
779 printf("Could not allocate memory for bsd driver data\n");
784 drv->sock = socket(PF_INET, SOCK_DGRAM, 0);
786 perror("socket[PF_INET,SOCK_DGRAM]");
789 os_strlcpy(drv->ifname, params->ifname, sizeof(drv->ifname));
791 drv->sock_xmit = l2_packet_init(drv->ifname, NULL, ETH_P_EAPOL,
792 handle_read, drv, 0);
793 if (drv->sock_xmit == NULL)
795 if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr))
798 /* mark down during setup */
799 if (bsd_ctrl_iface(drv, 0) < 0)
802 drv->route = socket(PF_ROUTE, SOCK_RAW, 0);
803 if (drv->route < 0) {
804 perror("socket(PF_ROUTE,SOCK_RAW)");
807 eloop_register_read_sock(drv->route, bsd_wireless_event_receive, drv,
810 if (bsd_set_mediaopt(drv, IFM_OMASK, IFM_IEEE80211_HOSTAP) < 0) {
811 wpa_printf(MSG_ERROR, "%s: failed to set operation mode",
818 if (drv->sock_xmit != NULL)
819 l2_packet_deinit(drv->sock_xmit);
829 bsd_deinit(void *priv)
831 struct bsd_driver_data *drv = priv;
833 if (drv->route >= 0) {
834 eloop_unregister_read_sock(drv->route);
837 bsd_ctrl_iface(drv, 0);
840 if (drv->sock_xmit != NULL)
841 l2_packet_deinit(drv->sock_xmit);
848 get80211param(struct bsd_driver_data *drv, int op)
850 struct ieee80211req ireq;
852 os_memset(&ireq, 0, sizeof(ireq));
853 os_strlcpy(ireq.i_name, drv->ifname, sizeof(ireq.i_name));
856 if (ioctl(drv->sock, SIOCG80211, &ireq) < 0) {
857 fprintf(stderr, "ioctl[SIOCG80211, op %u]: %s\n",
858 op, strerror(errno));
865 wpa_driver_bsd_get_bssid(void *priv, u8 *bssid)
867 struct bsd_driver_data *drv = priv;
868 #ifdef SIOCG80211BSSID
869 struct ieee80211_bssid bs;
871 os_strlcpy(bs.i_name, drv->ifname, sizeof(bs.i_name));
872 if (ioctl(drv->sock, SIOCG80211BSSID, &bs) < 0)
874 os_memcpy(bssid, bs.i_bssid, sizeof(bs.i_bssid));
877 return get80211var(drv, IEEE80211_IOC_BSSID,
878 bssid, IEEE80211_ADDR_LEN) < 0 ? -1 : 0;
883 wpa_driver_bsd_get_ssid(void *priv, u8 *ssid)
885 struct bsd_driver_data *drv = priv;
886 return bsd_get_ssid(drv->ifname, drv, ssid, 0);
890 wpa_driver_bsd_set_wpa_ie(struct bsd_driver_data *drv, const u8 *wpa_ie,
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 */
901 wpa_driver_bsd_set_wpa_internal(void *priv, int wpa, int privacy)
905 wpa_printf(MSG_DEBUG, "%s: wpa=%d privacy=%d",
906 __FUNCTION__, wpa, privacy);
908 if (!wpa && wpa_driver_bsd_set_wpa_ie(priv, NULL, 0) < 0)
910 if (set80211param(priv, IEEE80211_IOC_PRIVACY, privacy) < 0)
912 if (set80211param(priv, IEEE80211_IOC_WPA, wpa) < 0)
919 wpa_driver_bsd_set_wpa(void *priv, int enabled)
921 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled);
923 return wpa_driver_bsd_set_wpa_internal(priv, enabled ? 3 : 0, enabled);
927 wpa_driver_bsd_set_countermeasures(void *priv, int enabled)
929 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
930 return set80211param(priv, IEEE80211_IOC_COUNTERMEASURES, enabled);
935 wpa_driver_bsd_set_drop_unencrypted(void *priv, int enabled)
937 wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
938 return set80211param(priv, IEEE80211_IOC_DROPUNENCRYPTED, enabled);
942 wpa_driver_bsd_deauthenticate(void *priv, const u8 *addr, int reason_code)
944 return bsd_send_mlme_param(priv, IEEE80211_MLME_DEAUTH, reason_code,
949 wpa_driver_bsd_disassociate(void *priv, const u8 *addr, int reason_code)
951 return bsd_send_mlme_param(priv, IEEE80211_MLME_DISASSOC, reason_code,
956 wpa_driver_bsd_set_auth_alg(void *priv, int auth_alg)
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;
966 authmode = IEEE80211_AUTH_OPEN;
968 return set80211param(priv, IEEE80211_IOC_AUTHMODE, authmode);
972 handle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
974 struct bsd_driver_data *drv = ctx;
976 drv_event_eapol_rx(drv->ctx, src_addr, buf, len);
980 wpa_driver_bsd_associate(void *priv, struct wpa_driver_associate_params *params)
982 struct bsd_driver_data *drv = priv;
983 struct ieee80211req_mlme mlme;
989 wpa_printf(MSG_DEBUG,
990 "%s: ssid '%.*s' wpa ie len %u pairwise %u group %u key mgmt %u"
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
999 switch (params->mode) {
1000 case IEEE80211_MODE_INFRA:
1003 case IEEE80211_MODE_IBSS:
1004 mode = IFM_IEEE80211_IBSS;
1006 case IEEE80211_MODE_AP:
1007 mode = IFM_IEEE80211_HOSTAP;
1010 wpa_printf(MSG_ERROR, "%s: unknown operation mode", __func__);
1013 if (bsd_set_mediaopt(drv, IFM_OMASK, mode) < 0) {
1014 wpa_printf(MSG_ERROR, "%s: failed to set operation mode",
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)
1024 else if ((params->freq >= 5180 && params->freq <= 5240) ||
1025 (params->freq >= 5745 && params->freq <= 5825))
1026 channel = (params->freq - 5000) / 5;
1029 if (bsd_set_freq(drv, channel) < 0)
1032 drv->sock_xmit = l2_packet_init(drv->ifname, NULL, ETH_P_EAPOL,
1033 handle_read, drv, 0);
1034 if (drv->sock_xmit == NULL)
1040 if (wpa_driver_bsd_set_drop_unencrypted(drv, params->drop_unencrypted)
1043 if (wpa_driver_bsd_set_auth_alg(drv, params->auth_alg) < 0)
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)
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);
1055 if (set80211param(drv, IEEE80211_IOC_PRIVACY, privacy) < 0)
1058 if (params->wpa_ie_len &&
1059 set80211param(drv, IEEE80211_IOC_WPA,
1060 params->wpa_ie[0] == WLAN_EID_RSN ? 2 : 1) < 0)
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)
1076 wpa_driver_bsd_scan(void *priv, struct wpa_driver_scan_params *params)
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;
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__,
1090 if (wpa_driver_bsd_set_wpa(drv, 1) < 0) {
1091 wpa_printf(MSG_ERROR, "%s: failed to set wpa: %s", __func__,
1096 /* NB: interface must be marked UP to do a scan */
1097 if (bsd_ctrl_iface(drv, 1) < 0)
1100 /* set desired ssid before scan */
1101 if (bsd_set_ssid(drv->ifname, drv, ssid, ssid_len) < 0)
1104 /* NB: net80211 delivers a scan complete event so no need to poll */
1105 return set80211param(drv, IEEE80211_IOC_SCAN_REQ, 0);
1109 wpa_driver_bsd_event_receive(int sock, void *ctx, void *sock_ctx)
1111 struct bsd_driver_data *drv = sock_ctx;
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;
1122 n = read(sock, buf, sizeof(buf));
1124 if (errno != EINTR && errno != EAGAIN)
1125 perror("read(PF_ROUTE)");
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);
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)
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;
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);
1156 ifan = (struct if_announcemsghdr *) rtm;
1157 if (ifan->ifan_index != drv->ifindex)
1159 switch (ifan->ifan_what) {
1160 case RTM_IEEE80211_ASSOC:
1161 case RTM_IEEE80211_REASSOC:
1164 wpa_supplicant_event(ctx, EVENT_ASSOC, NULL);
1166 case RTM_IEEE80211_DISASSOC:
1169 wpa_supplicant_event(ctx, EVENT_DISASSOC, NULL);
1171 case RTM_IEEE80211_SCAN:
1174 wpa_supplicant_event(ctx, EVENT_SCAN_RESULTS, NULL);
1176 case RTM_IEEE80211_LEAVE:
1177 leave = (struct ieee80211_leave_event *) &ifan[1];
1178 drv_event_disassoc(ctx, leave->iev_addr);
1180 case RTM_IEEE80211_JOIN:
1181 #ifdef RTM_IEEE80211_REJOIN
1182 case RTM_IEEE80211_REJOIN:
1184 join = (struct ieee80211_join_event *) &ifan[1];
1185 bsd_new_sta(drv, ctx, join->iev_addr);
1187 case RTM_IEEE80211_REPLAY:
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));
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,
1206 ifm = (struct if_msghdr *) rtm;
1207 if (ifm->ifm_index != drv->ifindex)
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);
1222 wpa_driver_bsd_add_scan_entry(struct wpa_scan_results *res,
1223 struct ieee80211req_scan_result *sr)
1225 struct wpa_scan_res *result, **tmp;
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;
1234 result = os_zalloc(sizeof(*result) + extra_len);
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;
1244 pos = (u8 *)(result + 1);
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;
1252 * Deal all rates as supported rate.
1253 * Because net80211 doesn't report extended supported rate or not.
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;
1260 *pos++ = WLAN_EID_ERP_INFO;
1262 *pos++ = sr->isr_erp;
1264 os_memcpy(pos, (u8 *)(sr + 1) + sr->isr_ssid_len, sr->isr_ie_len);
1265 pos += sr->isr_ie_len;
1267 result->ie_len = pos - (u8 *)(result + 1);
1269 tmp = os_realloc(res->res,
1270 (res->num + 1) * sizeof(struct wpa_scan_res *));
1275 tmp[res->num++] = result;
1279 struct wpa_scan_results *
1280 wpa_driver_bsd_get_scan_results2(void *priv)
1282 struct ieee80211req_scan_result *sr;
1283 struct wpa_scan_results *res;
1285 uint8_t buf[24*1024], *pos;
1287 len = get80211var(priv, IEEE80211_IOC_SCAN_RESULTS, buf, 24*1024);
1291 res = os_zalloc(sizeof(*res));
1297 while (rest >= sizeof(struct ieee80211req_scan_result)) {
1298 sr = (struct ieee80211req_scan_result *)pos;
1299 wpa_driver_bsd_add_scan_entry(res, sr);
1301 rest -= sr->isr_len;
1304 wpa_printf(MSG_DEBUG, "Received %d bytes of scan results (%lu BSSes)",
1305 len, (unsigned long)res->num);
1310 static int wpa_driver_bsd_capa(struct bsd_driver_data *drv)
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;
1325 //drv->capa.max_scan_ssids = info.max_scan_ssids;
1326 drv->capa.flags |= WPA_DRIVER_FLAGS_AP;
1332 wpa_driver_bsd_init(void *ctx, const char *ifname)
1334 #define GETPARAM(drv, param, v) \
1335 (((v) = get80211param(drv, param)) != -1)
1336 struct bsd_driver_data *drv;
1338 drv = os_zalloc(sizeof(*drv));
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.
1347 drv->ifindex = if_nametoindex(ifname);
1348 if (drv->ifindex == 0) {
1349 wpa_printf(MSG_DEBUG, "%s: interface %s does not exist",
1353 drv->sock = socket(PF_INET, SOCK_DGRAM, 0);
1356 drv->route = socket(PF_ROUTE, SOCK_RAW, 0);
1359 eloop_register_read_sock(drv->route,
1360 wpa_driver_bsd_event_receive, ctx, drv);
1363 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
1365 /* Down interface during setup. */
1366 if (bsd_ctrl_iface(drv, 0) < 0)
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));
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));
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));
1385 if (bsd_set_mediaopt(drv, IFM_OMASK, 0 /* STA */) < 0) {
1386 wpa_printf(MSG_ERROR, "%s: failed to set operation mode",
1391 if (wpa_driver_bsd_capa(drv))
1404 wpa_driver_bsd_deinit(void *priv)
1406 struct bsd_driver_data *drv = priv;
1408 wpa_driver_bsd_set_wpa(drv, 0);
1409 eloop_unregister_read_sock(drv->route);
1411 /* NB: mark interface down */
1412 bsd_ctrl_iface(drv, 0);
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",
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 */
1427 wpa_driver_bsd_get_capa(void *priv, struct wpa_driver_capa *capa)
1429 struct bsd_driver_data *drv = priv;
1431 os_memcpy(capa, &drv->capa, sizeof(*capa));
1434 #endif /* HOSTAPD */
1437 const struct wpa_driver_ops wpa_driver_bsd_ops = {
1439 .desc = "BSD 802.11 support",
1441 .hapd_init = bsd_init,
1442 .hapd_deinit = bsd_deinit,
1443 .set_privacy = bsd_set_privacy,
1444 .get_seqnum = bsd_get_seqnum,
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,
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,