Merge wpa_supplicant and hostapd driver wrapper implementations
[wpasupplicant] / src / drivers / driver_bsd.c
index 6df3612..49e31c2 100644 (file)
@@ -1,6 +1,7 @@
 /*
  * WPA Supplicant - driver interaction with BSD net80211 layer
  * Copyright (c) 2004, Sam Leffler <sam@errno.com>
+ * Copyright (c) 2004, 2Wire, Inc
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 as
 #include <net80211/ieee80211_crypto.h>
 #include <net80211/ieee80211_ioctl.h>
 
+/*
+ * Avoid conflicts with hostapd definitions by undefining couple of defines
+ * from net80211 header files.
+ */
+#undef RSN_VERSION
+#undef WPA_VERSION
+#undef WPA_OUI_TYPE
+
+
+#ifdef HOSTAPD
+
+#include "l2_packet/l2_packet.h"
+#include "../../hostapd/hostapd.h"
+#include "../../hostapd/config.h"
+#include "../../hostapd/eapol_sm.h"
+
+struct bsd_driver_data {
+       struct hostapd_data *hapd;              /* back pointer */
+
+       char    iface[IFNAMSIZ + 1];
+       struct l2_packet_data *sock_xmit;       /* raw packet xmit socket */
+       int     ioctl_sock;                     /* socket for ioctl() use */
+       int     wext_sock;                      /* socket for wireless events */
+};
+
+static int bsd_sta_deauth(void *priv, const u8 *addr, int reason_code);
+
+static int
+set80211var(struct bsd_driver_data *drv, int op, const void *arg, int arg_len)
+{
+       struct ieee80211req ireq;
+
+       memset(&ireq, 0, sizeof(ireq));
+       os_strlcpy(ireq.i_name, drv->iface, IFNAMSIZ);
+       ireq.i_type = op;
+       ireq.i_len = arg_len;
+       ireq.i_data = (void *) arg;
+
+       if (ioctl(drv->ioctl_sock, SIOCS80211, &ireq) < 0) {
+               perror("ioctl[SIOCS80211]");
+               return -1;
+       }
+       return 0;
+}
+
+static int
+get80211var(struct bsd_driver_data *drv, int op, void *arg, int arg_len)
+{
+       struct ieee80211req ireq;
+
+       memset(&ireq, 0, sizeof(ireq));
+       os_strlcpy(ireq.i_name, drv->iface, IFNAMSIZ);
+       ireq.i_type = op;
+       ireq.i_len = arg_len;
+       ireq.i_data = arg;
+
+       if (ioctl(drv->ioctl_sock, SIOCG80211, &ireq) < 0) {
+               perror("ioctl[SIOCG80211]");
+               return -1;
+       }
+       return ireq.i_len;
+}
+
+static int
+set80211param(struct bsd_driver_data *drv, int op, int arg)
+{
+       struct ieee80211req ireq;
+
+       memset(&ireq, 0, sizeof(ireq));
+       os_strlcpy(ireq.i_name, drv->iface, IFNAMSIZ);
+       ireq.i_type = op;
+       ireq.i_val = arg;
+
+       if (ioctl(drv->ioctl_sock, SIOCS80211, &ireq) < 0) {
+               perror("ioctl[SIOCS80211]");
+               return -1;
+       }
+       return 0;
+}
+
+static const char *
+ether_sprintf(const u8 *addr)
+{
+       static char buf[sizeof(MACSTR)];
+
+       if (addr != NULL)
+               snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr));
+       else
+               snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0);
+       return buf;
+}
+
+/*
+ * Configure WPA parameters.
+ */
+static int
+bsd_configure_wpa(struct bsd_driver_data *drv)
+{
+       static const char *ciphernames[] =
+               { "WEP", "TKIP", "AES-OCB", "AES-CCM", "CKIP", "NONE" };
+       struct hostapd_data *hapd = drv->hapd;
+       struct hostapd_bss_config *conf = hapd->conf;
+       int v;
+
+       switch (conf->wpa_group) {
+       case WPA_CIPHER_CCMP:
+               v = IEEE80211_CIPHER_AES_CCM;
+               break;
+       case WPA_CIPHER_TKIP:
+               v = IEEE80211_CIPHER_TKIP;
+               break;
+       case WPA_CIPHER_WEP104:
+               v = IEEE80211_CIPHER_WEP;
+               break;
+       case WPA_CIPHER_WEP40:
+               v = IEEE80211_CIPHER_WEP;
+               break;
+       case WPA_CIPHER_NONE:
+               v = IEEE80211_CIPHER_NONE;
+               break;
+       default:
+               printf("Unknown group key cipher %u\n",
+                       conf->wpa_group);
+               return -1;
+       }
+       wpa_printf(MSG_DEBUG, "%s: group key cipher=%s (%u)",
+                  __func__, ciphernames[v], v);
+       if (set80211param(drv, IEEE80211_IOC_MCASTCIPHER, v)) {
+               printf("Unable to set group key cipher to %u (%s)\n",
+                       v, ciphernames[v]);
+               return -1;
+       }
+       if (v == IEEE80211_CIPHER_WEP) {
+               /* key length is done only for specific ciphers */
+               v = (conf->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5);
+               if (set80211param(drv, IEEE80211_IOC_MCASTKEYLEN, v)) {
+                       printf("Unable to set group key length to %u\n", v);
+                       return -1;
+               }
+       }
+
+       v = 0;
+       if (conf->wpa_pairwise & WPA_CIPHER_CCMP)
+               v |= 1<<IEEE80211_CIPHER_AES_CCM;
+       if (conf->wpa_pairwise & WPA_CIPHER_TKIP)
+               v |= 1<<IEEE80211_CIPHER_TKIP;
+       if (conf->wpa_pairwise & WPA_CIPHER_NONE)
+               v |= 1<<IEEE80211_CIPHER_NONE;
+       wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v);
+       if (set80211param(drv, IEEE80211_IOC_UCASTCIPHERS, v)) {
+               printf("Unable to set pairwise key ciphers to 0x%x\n", v);
+               return -1;
+       }
+
+       wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x",
+                  __func__, conf->wpa_key_mgmt);
+       if (set80211param(drv, IEEE80211_IOC_KEYMGTALGS, conf->wpa_key_mgmt)) {
+               printf("Unable to set key management algorithms to 0x%x\n",
+                       conf->wpa_key_mgmt);
+               return -1;
+       }
+
+       v = 0;
+       if (conf->rsn_preauth)
+               v |= BIT(0);
+       wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x",
+                  __func__, conf->rsn_preauth);
+       if (set80211param(drv, IEEE80211_IOC_RSNCAPS, v)) {
+               printf("Unable to set RSN capabilities to 0x%x\n", v);
+               return -1;
+       }
+
+       wpa_printf(MSG_DEBUG, "%s: enable WPA= 0x%x", __func__, conf->wpa);
+       if (set80211param(drv, IEEE80211_IOC_WPA, conf->wpa)) {
+               printf("Unable to set WPA to %u\n", conf->wpa);
+               return -1;
+       }
+       return 0;
+}
+
+
+static int
+bsd_set_iface_flags(void *priv, int dev_up)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ifreq ifr;
+
+       wpa_printf(MSG_DEBUG, "%s: dev_up=%d", __func__, dev_up);
+
+       if (drv->ioctl_sock < 0)
+               return -1;
+
+       memset(&ifr, 0, sizeof(ifr));
+       os_strlcpy(ifr.ifr_name, drv->iface, IFNAMSIZ);
+
+       if (ioctl(drv->ioctl_sock, SIOCGIFFLAGS, &ifr) != 0) {
+               perror("ioctl[SIOCGIFFLAGS]");
+               return -1;
+       }
+
+       if (dev_up)
+               ifr.ifr_flags |= IFF_UP;
+       else
+               ifr.ifr_flags &= ~IFF_UP;
+
+       if (ioctl(drv->ioctl_sock, SIOCSIFFLAGS, &ifr) != 0) {
+               perror("ioctl[SIOCSIFFLAGS]");
+               return -1;
+       }
+
+       if (dev_up) {
+               memset(&ifr, 0, sizeof(ifr));
+               os_strlcpy(ifr.ifr_name, drv->iface, IFNAMSIZ);
+               ifr.ifr_mtu = HOSTAPD_MTU;
+               if (ioctl(drv->ioctl_sock, SIOCSIFMTU, &ifr) != 0) {
+                       perror("ioctl[SIOCSIFMTU]");
+                       printf("Setting MTU failed - trying to survive with "
+                              "current value\n");
+               }
+       }
+
+       return 0;
+}
+
+static int
+bsd_set_ieee8021x(const char *ifname, void *priv, int enabled)
+{
+       struct bsd_driver_data *drv = priv;
+       struct hostapd_data *hapd = drv->hapd;
+       struct hostapd_bss_config *conf = hapd->conf;
+
+       wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
+
+       if (!enabled) {
+               /* XXX restore state */
+               return set80211param(priv, IEEE80211_IOC_AUTHMODE,
+                       IEEE80211_AUTH_AUTO);
+       }
+       if (!conf->wpa && !conf->ieee802_1x) {
+               hostapd_logger(hapd, NULL, HOSTAPD_MODULE_DRIVER,
+                       HOSTAPD_LEVEL_WARNING, "No 802.1X or WPA enabled!");
+               return -1;
+       }
+       if (conf->wpa && bsd_configure_wpa(drv) != 0) {
+               hostapd_logger(hapd, NULL, HOSTAPD_MODULE_DRIVER,
+                       HOSTAPD_LEVEL_WARNING, "Error configuring WPA state!");
+               return -1;
+       }
+       if (set80211param(priv, IEEE80211_IOC_AUTHMODE,
+               (conf->wpa ?  IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) {
+               hostapd_logger(hapd, NULL, HOSTAPD_MODULE_DRIVER,
+                       HOSTAPD_LEVEL_WARNING, "Error enabling WPA/802.1X!");
+               return -1;
+       }
+       return bsd_set_iface_flags(priv, 1);
+}
+
+static int
+bsd_set_privacy(const char *ifname, void *priv, int enabled)
+{
+       struct bsd_driver_data *drv = priv;
+
+       wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled);
+
+       return set80211param(drv, IEEE80211_IOC_PRIVACY, enabled);
+}
+
+static int
+bsd_set_sta_authorized(void *priv, const u8 *addr, int authorized)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_mlme mlme;
+
+       wpa_printf(MSG_DEBUG, "%s: addr=%s authorized=%d",
+                  __func__, ether_sprintf(addr), authorized);
+
+       if (authorized)
+               mlme.im_op = IEEE80211_MLME_AUTHORIZE;
+       else
+               mlme.im_op = IEEE80211_MLME_UNAUTHORIZE;
+       mlme.im_reason = 0;
+       memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
+       return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
+}
+
+static int
+bsd_sta_set_flags(void *priv, const u8 *addr, int total_flags, int flags_or,
+                 int flags_and)
+{
+       /* For now, only support setting Authorized flag */
+       if (flags_or & WLAN_STA_AUTHORIZED)
+               return bsd_set_sta_authorized(priv, addr, 1);
+       if (!(flags_and & WLAN_STA_AUTHORIZED))
+               return bsd_set_sta_authorized(priv, addr, 0);
+       return 0;
+}
+
+static int
+bsd_del_key(void *priv, const u8 *addr, int key_idx)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_del_key wk;
+
+       wpa_printf(MSG_DEBUG, "%s: addr=%s key_idx=%d",
+                  __func__, ether_sprintf(addr), key_idx);
+
+       memset(&wk, 0, sizeof(wk));
+       if (addr != NULL) {
+               memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN);
+               wk.idk_keyix = (u_int8_t) IEEE80211_KEYIX_NONE; /* XXX */
+       } else {
+               wk.idk_keyix = key_idx;
+       }
+
+       return set80211var(drv, IEEE80211_IOC_DELKEY, &wk, sizeof(wk));
+}
+
+static int
+bsd_set_key(const char *ifname, void *priv, wpa_alg alg,
+           const u8 *addr, int key_idx, int set_tx, const u8 *seq,
+           size_t seq_len, const u8 *key, size_t key_len)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_key wk;
+       u_int8_t cipher;
+
+       if (alg == WPA_ALG_NONE)
+               return bsd_del_key(drv, addr, key_idx);
+
+       wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%s key_idx=%d",
+                  __func__, alg, ether_sprintf(addr), key_idx);
+
+       if (alg == WPA_ALG_WEP)
+               cipher = IEEE80211_CIPHER_WEP;
+       else if (alg == WPA_ALG_TKIP)
+               cipher = IEEE80211_CIPHER_TKIP;
+       else if (alg == WPA_ALG_CCMP)
+               cipher = IEEE80211_CIPHER_AES_CCM;
+       else {
+               printf("%s: unknown/unsupported algorithm %d\n",
+                       __func__, alg);
+               return -1;
+       }
+
+       if (key_len > sizeof(wk.ik_keydata)) {
+               printf("%s: key length %d too big\n", __func__, key_len);
+               return -3;
+       }
+
+       memset(&wk, 0, sizeof(wk));
+       wk.ik_type = cipher;
+       wk.ik_flags = IEEE80211_KEY_RECV | IEEE80211_KEY_XMIT;
+       if (addr == NULL) {
+               memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
+               wk.ik_keyix = key_idx;
+               wk.ik_flags |= IEEE80211_KEY_DEFAULT;
+       } else {
+               memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
+               wk.ik_keyix = IEEE80211_KEYIX_NONE;
+       }
+       wk.ik_keylen = key_len;
+       memcpy(wk.ik_keydata, key, key_len);
+
+       return set80211var(drv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk));
+}
+
+
+static int
+bsd_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx,
+              u8 *seq)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_key wk;
+
+       wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d",
+                  __func__, ether_sprintf(addr), idx);
+
+       memset(&wk, 0, sizeof(wk));
+       if (addr == NULL)
+               memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
+       else
+               memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN);
+       wk.ik_keyix = idx;
+
+       if (get80211var(drv, IEEE80211_IOC_WPAKEY, &wk, sizeof(wk)) < 0) {
+               printf("Failed to get encryption.\n");
+               return -1;
+       }
+
+#ifdef WORDS_BIGENDIAN
+       {
+               /*
+                * wk.ik_keytsc is in host byte order (big endian), need to
+                * swap it to match with the byte order used in WPA.
+                */
+               int i;
+               u8 tmp[WPA_KEY_RSC_LEN];
+               memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
+               for (i = 0; i < WPA_KEY_RSC_LEN; i++) {
+                       seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1];
+               }
+       }
+#else /* WORDS_BIGENDIAN */
+       memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc));
+#endif /* WORDS_BIGENDIAN */
+       return 0;
+}
+
+
+static int 
+bsd_flush(void *priv)
+{
+       u8 allsta[IEEE80211_ADDR_LEN];
+
+       memset(allsta, 0xff, IEEE80211_ADDR_LEN);
+       return bsd_sta_deauth(priv, allsta, IEEE80211_REASON_AUTH_LEAVE);
+}
+
+
+static int
+bsd_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data,
+                        const u8 *addr)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_sta_stats stats;
+
+       memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN);
+       if (get80211var(drv, IEEE80211_IOC_STA_STATS, &stats, sizeof(stats)) > 0) {
+               /* XXX? do packets counts include non-data frames? */
+               data->rx_packets = stats.is_stats.ns_rx_data;
+               data->rx_bytes = stats.is_stats.ns_rx_bytes;
+               data->tx_packets = stats.is_stats.ns_tx_data;
+               data->tx_bytes = stats.is_stats.ns_tx_bytes;
+       }
+       return 0;
+}
+
+static int
+bsd_set_opt_ie(const char *ifname, void *priv, const u8 *ie, size_t ie_len)
+{
+       /*
+        * Do nothing; we setup parameters at startup that define the
+        * contents of the beacon information element.
+        */
+       return 0;
+}
+
+static int
+bsd_sta_deauth(void *priv, const u8 *addr, int reason_code)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_mlme mlme;
+
+       wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d",
+                  __func__, ether_sprintf(addr), reason_code);
+
+       mlme.im_op = IEEE80211_MLME_DEAUTH;
+       mlme.im_reason = reason_code;
+       memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
+       return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
+}
+
+static int
+bsd_sta_disassoc(void *priv, const u8 *addr, int reason_code)
+{
+       struct bsd_driver_data *drv = priv;
+       struct ieee80211req_mlme mlme;
+
+       wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d",
+                  __func__, ether_sprintf(addr), reason_code);
+
+       mlme.im_op = IEEE80211_MLME_DISASSOC;
+       mlme.im_reason = reason_code;
+       memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN);
+       return set80211var(drv, IEEE80211_IOC_MLME, &mlme, sizeof(mlme));
+}
+
+static int
+bsd_new_sta(struct bsd_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN])
+{
+       struct hostapd_data *hapd = drv->hapd;
+       struct ieee80211req_wpaie ie;
+       int ielen = 0;
+       u8 *iebuf = NULL;
+
+       /*
+        * Fetch and validate any negotiated WPA/RSN parameters.
+        */
+       memset(&ie, 0, sizeof(ie));
+       memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN);
+       if (get80211var(drv, IEEE80211_IOC_WPAIE, &ie, sizeof(ie)) < 0) {
+               printf("Failed to get WPA/RSN information element.\n");
+               goto no_ie;
+       }
+       iebuf = ie.wpa_ie;
+       ielen = ie.wpa_ie[1];
+       if (ielen == 0)
+               iebuf = NULL;
+       else
+               ielen += 2;
+
+no_ie:
+       return hostapd_notif_assoc(hapd, addr, iebuf, ielen);
+}
+
+#include <net/route.h>
+#include <net80211/ieee80211_freebsd.h>
+
+static void
+bsd_wireless_event_receive(int sock, void *ctx, void *sock_ctx)
+{
+       struct bsd_driver_data *drv = ctx;
+       struct hostapd_data *hapd = drv->hapd;
+       char buf[2048];
+       struct if_announcemsghdr *ifan;
+       struct rt_msghdr *rtm;
+       struct ieee80211_michael_event *mic;
+       struct ieee80211_join_event *join;
+       struct ieee80211_leave_event *leave;
+       int n;
+
+       n = read(sock, buf, sizeof(buf));
+       if (n < 0) {
+               if (errno != EINTR && errno != EAGAIN)
+                       perror("read(PF_ROUTE)");
+               return;
+       }
+
+       rtm = (struct rt_msghdr *) buf;
+       if (rtm->rtm_version != RTM_VERSION) {
+               wpa_printf(MSG_DEBUG, "Routing message version %d not "
+                       "understood\n", rtm->rtm_version);
+               return;
+       }
+       ifan = (struct if_announcemsghdr *) rtm;
+       switch (rtm->rtm_type) {
+       case RTM_IEEE80211:
+               switch (ifan->ifan_what) {
+               case RTM_IEEE80211_ASSOC:
+               case RTM_IEEE80211_REASSOC:
+               case RTM_IEEE80211_DISASSOC:
+               case RTM_IEEE80211_SCAN:
+                       break;
+               case RTM_IEEE80211_LEAVE:
+                       leave = (struct ieee80211_leave_event *) &ifan[1];
+                       hostapd_notif_disassoc(drv->hapd, leave->iev_addr);
+                       break;
+               case RTM_IEEE80211_JOIN:
+#ifdef RTM_IEEE80211_REJOIN
+               case RTM_IEEE80211_REJOIN:
+#endif
+                       join = (struct ieee80211_join_event *) &ifan[1];
+                       bsd_new_sta(drv, join->iev_addr);
+                       break;
+               case RTM_IEEE80211_REPLAY:
+                       /* ignore */
+                       break;
+               case RTM_IEEE80211_MICHAEL:
+                       mic = (struct ieee80211_michael_event *) &ifan[1];
+                       wpa_printf(MSG_DEBUG,
+                               "Michael MIC failure wireless event: "
+                               "keyix=%u src_addr=" MACSTR, mic->iev_keyix,
+                               MAC2STR(mic->iev_src));
+                       hostapd_michael_mic_failure(hapd, mic->iev_src);
+                       break;
+               }
+               break;
+       }
+}
+
+static int
+bsd_wireless_event_init(struct bsd_driver_data *drv)
+{
+       int s;
+
+       drv->wext_sock = -1;
+
+       s = socket(PF_ROUTE, SOCK_RAW, 0);
+       if (s < 0) {
+               perror("socket(PF_ROUTE,SOCK_RAW)");
+               return -1;
+       }
+       eloop_register_read_sock(s, bsd_wireless_event_receive, drv, NULL);
+       drv->wext_sock = s;
+
+       return 0;
+}
+
+static void
+bsd_wireless_event_deinit(struct bsd_driver_data *drv)
+{
+       if (drv->wext_sock < 0)
+               return;
+       eloop_unregister_read_sock(drv->wext_sock);
+       close(drv->wext_sock);
+}
+
+
+static int
+bsd_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len,
+              int encrypt, const u8 *own_addr)
+{
+       struct bsd_driver_data *drv = priv;
+       unsigned char buf[3000];
+       unsigned char *bp = buf;
+       struct l2_ethhdr *eth;
+       size_t len;
+       int status;
+
+       /*
+        * Prepend the Etherent header.  If the caller left us
+        * space at the front we could just insert it but since
+        * we don't know we copy to a local buffer.  Given the frequency
+        * and size of frames this probably doesn't matter.
+        */
+       len = data_len + sizeof(struct l2_ethhdr);
+       if (len > sizeof(buf)) {
+               bp = malloc(len);
+               if (bp == NULL) {
+                       printf("EAPOL frame discarded, cannot malloc temp "
+                               "buffer of size %u!\n", len);
+                       return -1;
+               }
+       }
+       eth = (struct l2_ethhdr *) bp;
+       memcpy(eth->h_dest, addr, ETH_ALEN);
+       memcpy(eth->h_source, own_addr, ETH_ALEN);
+       eth->h_proto = htons(ETH_P_EAPOL);
+       memcpy(eth+1, data, data_len);
+
+       wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len);
+
+       status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len);
+
+       if (bp != buf)
+               free(bp);
+       return status;
+}
+
+static void
+handle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len)
+{
+       struct bsd_driver_data *drv = ctx;
+       hostapd_eapol_receive(drv->hapd, src_addr,
+                             buf + sizeof(struct l2_ethhdr),
+                             len - sizeof(struct l2_ethhdr));
+}
+
+static int
+bsd_get_ssid(const char *ifname, void *priv, u8 *buf, int len)
+{
+       struct bsd_driver_data *drv = priv;
+       int ssid_len = get80211var(drv, IEEE80211_IOC_SSID, buf, len);
+
+       wpa_printf(MSG_DEBUG, "%s: ssid=\"%.*s\"", __func__, ssid_len, buf);
+
+       return ssid_len;
+}
+
+static int
+bsd_set_ssid(const char *ifname, void *priv, const u8 *buf, int len)
+{
+       struct bsd_driver_data *drv = priv;
+
+       wpa_printf(MSG_DEBUG, "%s: ssid=\"%.*s\"", __func__, len, buf);
+
+       return set80211var(drv, IEEE80211_IOC_SSID, buf, len);
+}
+
+static void *
+bsd_init(struct hostapd_data *hapd)
+{
+       struct bsd_driver_data *drv;
+
+       drv = os_zalloc(sizeof(struct bsd_driver_data));
+       if (drv == NULL) {
+               printf("Could not allocate memory for bsd driver data\n");
+               goto bad;
+       }
+
+       drv->hapd = hapd;
+       drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0);
+       if (drv->ioctl_sock < 0) {
+               perror("socket[PF_INET,SOCK_DGRAM]");
+               goto bad;
+       }
+       memcpy(drv->iface, hapd->conf->iface, sizeof(drv->iface));
+
+       drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL,
+                                       handle_read, drv, 1);
+       if (drv->sock_xmit == NULL)
+               goto bad;
+       if (l2_packet_get_own_addr(drv->sock_xmit, hapd->own_addr))
+               goto bad;
+
+       bsd_set_iface_flags(drv, 0);    /* mark down during setup */
+       if (bsd_wireless_event_init(drv))
+               goto bad;
+
+       return drv;
+bad:
+       if (drv->sock_xmit != NULL)
+               l2_packet_deinit(drv->sock_xmit);
+       if (drv->ioctl_sock >= 0)
+               close(drv->ioctl_sock);
+       if (drv != NULL)
+               free(drv);
+       return NULL;
+}
+
+
+static void
+bsd_deinit(void *priv)
+{
+       struct bsd_driver_data *drv = priv;
+
+       bsd_wireless_event_deinit(drv);
+       (void) bsd_set_iface_flags(drv, 0);
+       if (drv->ioctl_sock >= 0)
+               close(drv->ioctl_sock);
+       if (drv->sock_xmit != NULL)
+               l2_packet_deinit(drv->sock_xmit);
+       free(drv);
+}
+
+const struct wpa_driver_ops wpa_driver_bsd_ops = {
+       .name                   = "bsd",
+       .hapd_init              = bsd_init,
+       .hapd_deinit            = bsd_deinit,
+       .set_ieee8021x          = bsd_set_ieee8021x,
+       .set_privacy            = bsd_set_privacy,
+       .hapd_set_key           = bsd_set_key,
+       .get_seqnum             = bsd_get_seqnum,
+       .flush                  = bsd_flush,
+       .set_generic_elem       = bsd_set_opt_ie,
+       .sta_set_flags          = bsd_sta_set_flags,
+       .read_sta_data          = bsd_read_sta_driver_data,
+       .hapd_send_eapol        = bsd_send_eapol,
+       .sta_disassoc           = bsd_sta_disassoc,
+       .sta_deauth             = bsd_sta_deauth,
+       .hapd_set_ssid          = bsd_set_ssid,
+       .hapd_get_ssid          = bsd_get_ssid,
+};
+
+#else /* HOSTAPD */
+
 struct wpa_driver_bsd_data {
        int     sock;                   /* open socket for 802.11 ioctls */
        int     route;                  /* routing socket for events */
@@ -798,3 +1545,5 @@ const struct wpa_driver_ops wpa_driver_bsd_ops = {
        .associate              = wpa_driver_bsd_associate,
        .set_auth_alg           = wpa_driver_bsd_set_auth_alg,
 };
+
+#endif /* HOSTAPD */