#include "hostapd.h"
#include "ieee802_11_defs.h"
+#include "ieee802_11_common.h"
+#include "eloop.h"
#include "hw_features.h"
#include "driver_i.h"
#include "config.h"
}
-static int ieee80211n_check_40mhz_5g(struct hostapd_iface *iface)
+static void ieee80211n_get_pri_sec_chan(struct wpa_scan_res *bss,
+ int *pri_chan, int *sec_chan)
+{
+ struct ieee80211_ht_operation *oper;
+ struct ieee802_11_elems elems;
+
+ *pri_chan = *sec_chan = 0;
+
+ ieee802_11_parse_elems((u8 *) (bss + 1), bss->ie_len, &elems, 0);
+ if (elems.ht_operation &&
+ elems.ht_operation_len >= sizeof(*oper)) {
+ oper = (struct ieee80211_ht_operation *) elems.ht_operation;
+ *pri_chan = oper->control_chan;
+ if (oper->ht_param & HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH) {
+ if (oper->ht_param &
+ HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE)
+ *sec_chan = *pri_chan + 4;
+ else if (oper->ht_param &
+ HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW)
+ *sec_chan = *pri_chan - 4;
+ }
+ }
+}
+
+
+static int ieee80211n_check_40mhz_5g(struct hostapd_iface *iface,
+ struct wpa_scan_results *scan_res)
{
int pri_chan, sec_chan, pri_freq, sec_freq, pri_bss, sec_bss;
- const struct hostapd_neighbor_bss *n;
- size_t i, num;
+ int bss_pri_chan, bss_sec_chan;
+ size_t i;
int match;
pri_chan = iface->conf->channel;
else
sec_freq = pri_freq - 20;
- n = hostapd_driver_get_neighbor_bss(iface->bss[0], &num);
-
/*
* Switch PRI/SEC channels if Beacons were detected on selected SEC
* channel, but not on selected PRI channel.
*/
pri_bss = sec_bss = 0;
- for (i = 0; n && i < num; i++) {
- if (n[i].freq == pri_freq)
+ for (i = 0; i < scan_res->num; i++) {
+ struct wpa_scan_res *bss = scan_res->res[i];
+ if (bss->freq == pri_freq)
pri_bss++;
- else if (n[i].freq == sec_freq)
+ else if (bss->freq == sec_freq)
sec_bss++;
}
if (sec_bss && !pri_bss) {
* existing BSSes, use own preference).
*/
match = 0;
- for (i = 0; n && i < num; i++) {
- if (pri_chan == n[i].pri_chan &&
- sec_chan == n[i].sec_chan) {
+ for (i = 0; i < scan_res->num; i++) {
+ struct wpa_scan_res *bss = scan_res->res[i];
+ ieee80211n_get_pri_sec_chan(bss, &bss_pri_chan, &bss_sec_chan);
+ if (pri_chan == bss_pri_chan &&
+ sec_chan == bss_sec_chan) {
match = 1;
break;
}
}
if (!match) {
- for (i = 0; n && i < num; i++) {
- if (pri_chan == n[i].sec_chan &&
- sec_chan == n[i].pri_chan) {
+ for (i = 0; i < scan_res->num; i++) {
+ struct wpa_scan_res *bss = scan_res->res[i];
+ ieee80211n_get_pri_sec_chan(bss, &pri_chan, &sec_chan);
+ if (pri_chan == bss_sec_chan &&
+ sec_chan == bss_pri_chan) {
wpa_printf(MSG_INFO, "Switch own primary and "
"secondary channel due to BSS "
"overlap with " MACSTR,
- MAC2STR(n[i].bssid));
+ MAC2STR(bss->bssid));
ieee80211n_switch_pri_sec(iface);
break;
}
}
-static int ieee80211n_check_40mhz_2g4(struct hostapd_iface *iface)
+static int ieee80211n_check_40mhz_2g4(struct hostapd_iface *iface,
+ struct wpa_scan_results *scan_res)
{
int pri_freq, sec_freq;
int affected_start, affected_end;
- const struct hostapd_neighbor_bss *n;
- size_t i, num;
+ size_t i;
pri_freq = hostapd_hw_get_freq(iface->bss[0], iface->conf->channel);
if (iface->conf->secondary_channel > 0)
affected_end = (pri_freq + sec_freq) / 2 + 25;
wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
affected_start, affected_end);
- n = hostapd_driver_get_neighbor_bss(iface->bss[0], &num);
- for (i = 0; n && i < num; i++) {
- int pri = n[i].freq;
+ for (i = 0; i < scan_res->num; i++) {
+ struct wpa_scan_res *bss = scan_res->res[i];
+ int pri = bss->freq;
int sec = pri;
- if (n[i].sec_chan) {
- if (n[i].sec_chan < n[i].pri_chan)
+ int sec_chan, pri_chan;
+
+ ieee80211n_get_pri_sec_chan(bss, &pri_chan, &sec_chan);
+
+ if (sec_chan) {
+ if (sec_chan < pri_chan)
sec = pri - 20;
else
sec = pri + 20;
(sec < affected_start || sec > affected_end))
continue; /* not within affected channel range */
- if (n[i].sec_chan) {
+ wpa_printf(MSG_DEBUG, "Neighboring BSS: " MACSTR
+ " freq=%d pri=%d sec=%d",
+ MAC2STR(bss->bssid), bss->freq, pri_chan, sec_chan);
+
+ if (sec_chan) {
if (pri_freq != pri || sec_freq != sec) {
wpa_printf(MSG_DEBUG, "40 MHz pri/sec "
"mismatch with BSS " MACSTR
" <%d,%d> (chan=%d%c) vs. <%d,%d>",
- MAC2STR(n[i].bssid),
- pri, sec, n[i].pri_chan,
+ MAC2STR(bss->bssid),
+ pri, sec, pri_chan,
sec > pri ? '+' : '-',
pri_freq, sec_freq);
return 0;
}
-static void ieee80211n_check_40mhz(struct hostapd_iface *iface)
+static void ieee80211n_check_scan(struct hostapd_iface *iface)
{
+ struct wpa_scan_results *scan_res;
int oper40;
- if (!iface->conf->secondary_channel)
- return; /* HT40 not used */
-
/* Check list of neighboring BSSes (from scan) to see whether 40 MHz is
* allowed per IEEE 802.11n/D7.0, 11.14.3.2 */
+ iface->scan_cb = NULL;
+
+ scan_res = hostapd_driver_get_scan_results(iface->bss[0]);
+ if (scan_res == NULL) {
+ hostapd_setup_interface_complete(iface, 1);
+ return;
+ }
+
if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211A)
- oper40 = ieee80211n_check_40mhz_5g(iface);
+ oper40 = ieee80211n_check_40mhz_5g(iface, scan_res);
else
- oper40 = ieee80211n_check_40mhz_2g4(iface);
+ oper40 = ieee80211n_check_40mhz_2g4(iface, scan_res);
+ wpa_scan_results_free(scan_res);
if (!oper40) {
wpa_printf(MSG_INFO, "20/40 MHz operation not permitted on "
iface->conf->secondary_channel = 0;
iface->conf->ht_capab &= ~HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET;
}
+
+ hostapd_setup_interface_complete(iface, 0);
+}
+
+
+static int ieee80211n_check_40mhz(struct hostapd_iface *iface)
+{
+ struct wpa_driver_scan_params params;
+
+ if (!iface->conf->secondary_channel)
+ return 0; /* HT40 not used */
+
+ wpa_printf(MSG_DEBUG, "Scan for neighboring BSSes prior to enabling "
+ "40 MHz channel");
+ os_memset(¶ms, 0, sizeof(params));
+ /* TODO: scan only the needed frequency */
+ if (hostapd_driver_scan(iface->bss[0], ¶ms) < 0) {
+ wpa_printf(MSG_ERROR, "Failed to request a scan of "
+ "neighboring BSSes");
+ return -1;
+ }
+
+ iface->scan_cb = ieee80211n_check_scan;
+ return 1;
}
return 1;
}
+
+#endif /* CONFIG_IEEE80211N */
+
+
+int hostapd_check_ht_capab(struct hostapd_iface *iface)
+{
+#ifdef CONFIG_IEEE80211N
+ int ret;
+ ret = ieee80211n_check_40mhz(iface);
+ if (ret)
+ return ret;
+ if (!ieee80211n_allowed_ht40_channel_pair(iface))
+ return -1;
+ if (!ieee80211n_supported_ht_capab(iface))
+ return -1;
#endif /* CONFIG_IEEE80211N */
+ return 0;
+}
+
/**
* hostapd_select_hw_mode - Select the hardware mode
return -1;
}
-#ifdef CONFIG_IEEE80211N
- ieee80211n_check_40mhz(iface);
- if (!ieee80211n_allowed_ht40_channel_pair(iface))
- return -1;
- if (!ieee80211n_supported_ht_capab(iface))
- return -1;
-#endif /* CONFIG_IEEE80211N */
-
if (hostapd_prepare_rates(iface->bss[0], iface->current_mode)) {
wpa_printf(MSG_ERROR, "Failed to prepare rates table.");
hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
int associated;
u8 ssid[32];
size_t ssid_len;
+ int nlmode;
+ int ap_scan_as_station;
#if defined(CONFIG_AP) || defined(HOSTAPD)
int beacon_int;
int num_if_indices;
struct i802_bss bss;
- unsigned int ht_40mhz_scan:1;
int last_freq;
int last_freq_ht;
- struct hostapd_neighbor_bss *neighbors;
- size_t num_neighbors;
#endif /* HOSTAPD */
};
static void wpa_driver_nl80211_scan_timeout(void *eloop_ctx,
void *timeout_ctx);
-static int wpa_driver_nl80211_set_mode(struct wpa_driver_nl80211_data *drv,
- int mode);
+static int wpa_driver_nl80211_set_mode(void *priv, int mode);
static int
wpa_driver_nl80211_finish_drv_init(struct wpa_driver_nl80211_data *drv);
static void mlme_event_michael_mic_failure(struct wpa_driver_nl80211_data *drv,
struct nlattr *tb[])
{
-#ifdef HOSTAPD
- if (tb[NL80211_ATTR_MAC])
- hostapd_michael_mic_failure(drv->hapd,
- nla_data(tb[NL80211_ATTR_MAC]));
-#else /* HOSTAPD */
union wpa_event_data data;
wpa_printf(MSG_DEBUG, "nl80211: MLME event Michael MIC failure");
wpa_hexdump(MSG_DEBUG, "nl80211: Source MAC address",
nla_data(tb[NL80211_ATTR_MAC]),
nla_len(tb[NL80211_ATTR_MAC]));
+ data.michael_mic_failure.src = nla_data(tb[NL80211_ATTR_MAC]);
}
if (tb[NL80211_ATTR_KEY_SEQ]) {
wpa_hexdump(MSG_DEBUG, "nl80211: TSC",
}
wpa_supplicant_event(drv->ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
-#endif /* HOSTAPD */
}
}
}
+ if (drv->ap_scan_as_station &&
+ (gnlh->cmd == NL80211_CMD_NEW_SCAN_RESULTS ||
+ gnlh->cmd == NL80211_CMD_SCAN_ABORTED)) {
+ wpa_driver_nl80211_set_mode(drv, IEEE80211_MODE_AP);
+ drv->ap_scan_as_station = 0;
+ }
+
switch (gnlh->cmd) {
-#ifndef HOSTAPD
case NL80211_CMD_NEW_SCAN_RESULTS:
wpa_printf(MSG_DEBUG, "nl80211: New scan results available");
drv->scan_complete_events = 1;
drv->ctx);
wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, NULL);
break;
+#ifndef HOSTAPD
case NL80211_CMD_AUTHENTICATE:
case NL80211_CMD_ASSOCIATE:
case NL80211_CMD_DEAUTHENTICATE:
{
drv->ifindex = if_nametoindex(drv->ifname);
- if (wpa_driver_nl80211_set_mode(drv, 0) < 0) {
+ if (wpa_driver_nl80211_set_mode(drv, IEEE80211_MODE_INFRA) < 0) {
wpa_printf(MSG_DEBUG, "nl80211: Could not configure driver to "
"use managed mode");
}
eloop_unregister_read_sock(drv->link_event_sock);
hostapd_set_iface_flags(drv, drv->ifname, 0);
- wpa_driver_nl80211_set_mode(drv, 0);
+ wpa_driver_nl80211_set_mode(drv, IEEE80211_MODE_INFRA);
close(drv->link_event_sock);
close(drv->ioctl_sock);
/**
* wpa_driver_nl80211_scan_timeout - Scan timeout to report scan completion
- * @eloop_ctx: Unused
+ * @eloop_ctx: Driver private data
* @timeout_ctx: ctx argument given to wpa_driver_nl80211_init()
*
* This function can be used as registered timeout when starting a scan to
*/
static void wpa_driver_nl80211_scan_timeout(void *eloop_ctx, void *timeout_ctx)
{
+ struct wpa_driver_nl80211_data *drv = eloop_ctx;
+ if (drv->ap_scan_as_station) {
+ wpa_driver_nl80211_set_mode(drv, IEEE80211_MODE_AP);
+ drv->ap_scan_as_station = 0;
+ }
wpa_printf(MSG_DEBUG, "Scan timeout - try to get results");
-#ifndef HOSTAPD
wpa_supplicant_event(timeout_ctx, EVENT_SCAN_RESULTS, NULL);
-#endif /* HOSTAPD */
}
/**
* wpa_driver_nl80211_scan - Request the driver to initiate scan
- * @priv: Pointer to private wext data from wpa_driver_nl80211_init()
+ * @priv: Pointer to private driver data from wpa_driver_nl80211_init()
* @params: Scan parameters
* Returns: 0 on success, -1 on failure
*/
if (ret) {
wpa_printf(MSG_DEBUG, "nl80211: Scan trigger failed: ret=%d "
"(%s)", ret, strerror(-ret));
+#ifdef HOSTAPD
+ if (drv->nlmode == NL80211_IFTYPE_AP) {
+ /*
+ * mac80211 does not allow scan requests in AP mode, so
+ * try to do this in station mode.
+ */
+ if (wpa_driver_nl80211_set_mode(drv,
+ IEEE80211_MODE_INFRA))
+ goto nla_put_failure;
+
+ if (wpa_driver_nl80211_scan(drv, params)) {
+ wpa_driver_nl80211_set_mode(drv,
+ IEEE80211_MODE_AP);
+ goto nla_put_failure;
+ }
+
+ /* Restore AP mode when processing scan results */
+ drv->ap_scan_as_station = 1;
+ ret = 0;
+ } else
+ goto nla_put_failure;
+#else /* HOSTAPD */
goto nla_put_failure;
+#endif /* HOSTAPD */
}
/* Not all drivers generate "scan completed" wireless event, so try to
}
-/**
- * wpa_driver_nl80211_set_mode - Set wireless mode (infra/adhoc)
- * @drv: Pointer to private driver data from wpa_driver_nl80211_init()
- * @mode: 0 = infra/BSS (associate with an AP), 1 = adhoc/IBSS
- * Returns: 0 on success, -1 on failure
- */
-static int wpa_driver_nl80211_set_mode(struct wpa_driver_nl80211_data *drv,
- int mode)
+static int nl80211_set_mode(struct wpa_driver_nl80211_data *drv,
+ int ifindex, int mode)
{
- int ret = -1;
struct nl_msg *msg;
+ int ret = -ENOBUFS;
+
+ msg = nlmsg_alloc();
+ if (!msg)
+ return -ENOMEM;
+
+ genlmsg_put(msg, 0, 0, genl_family_get_id(drv->nl80211), 0,
+ 0, NL80211_CMD_SET_INTERFACE, 0);
+ NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, ifindex);
+ NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, mode);
+
+ ret = send_and_recv_msgs(drv, msg, NULL, NULL);
+ if (!ret)
+ return 0;
+nla_put_failure:
+ wpa_printf(MSG_DEBUG, "nl80211: Failed to set interface %d to mode %d:"
+ " %d (%s)", ifindex, mode, ret, strerror(-ret));
+ return ret;
+}
+
+
+static int wpa_driver_nl80211_set_mode(void *priv, int mode)
+{
+ struct wpa_driver_nl80211_data *drv = priv;
+ int ret = -1;
int nlmode;
switch (mode) {
return -1;
}
- msg = nlmsg_alloc();
- if (!msg)
- return -1;
-
- genlmsg_put(msg, 0, 0, genl_family_get_id(drv->nl80211), 0,
- 0, NL80211_CMD_SET_INTERFACE, 0);
- NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, drv->ifindex);
- NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, nlmode);
-
- ret = send_and_recv_msgs(drv, msg, NULL, NULL);
- if (!ret)
+ if (nl80211_set_mode(drv, drv->ifindex, nlmode) == 0) {
+ drv->nlmode = nlmode;
return 0;
- else
- goto try_again;
+ }
-nla_put_failure:
- wpa_printf(MSG_ERROR, "nl80211: Failed to set interface mode: %d (%s)",
- ret, strerror(-ret));
- return -1;
+ if (nlmode == drv->nlmode)
+ return 0; /* Already in the requested mode */
-try_again:
/* mac80211 doesn't allow mode changes while the device is up, so
* take the device down, try to set the mode again, and bring the
* device back up.
*/
if (hostapd_set_iface_flags(drv, drv->ifname, 0) == 0) {
/* Try to set the mode again while the interface is down */
- msg = nlmsg_alloc();
- if (!msg)
- return -1;
-
- genlmsg_put(msg, 0, 0, genl_family_get_id(drv->nl80211), 0,
- 0, NL80211_CMD_SET_INTERFACE, 0);
- NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, drv->ifindex);
- NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, nlmode);
- ret = send_and_recv_msgs(drv, msg, NULL, NULL);
- if (ret) {
- wpa_printf(MSG_ERROR, "Failed to set interface %s "
- "mode(try_again): %d (%s)",
- drv->ifname, ret, strerror(-ret));
- }
-
+ ret = nl80211_set_mode(drv, drv->ifindex, nlmode);
if (hostapd_set_iface_flags(drv, drv->ifname, 1))
ret = -1;
}
+ if (!ret)
+ drv->nlmode = nlmode;
+
return ret;
}
}
-static int nl80211_set_mode(struct wpa_driver_nl80211_data *drv, const char *ifname,
- int mode)
-{
- struct nl_msg *msg;
- int ret = -ENOBUFS;
-
- msg = nlmsg_alloc();
- if (!msg)
- return -ENOMEM;
-
- genlmsg_put(msg, 0, 0, genl_family_get_id(drv->nl80211), 0,
- 0, NL80211_CMD_SET_INTERFACE, 0);
- NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX,
- if_nametoindex(ifname));
- NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, mode);
-
- ret = send_and_recv_msgs(drv, msg, NULL, NULL);
- if (!ret)
- return 0;
- nla_put_failure:
- wpa_printf(MSG_ERROR, "Failed to set interface %s to master "
- "mode.", ifname);
- return ret;
-}
-
-
-#ifdef CONFIG_IEEE80211N
-static void i802_add_neighbor(struct wpa_driver_nl80211_data *drv, u8 *bssid,
- int freq, u8 *ie, size_t ie_len)
-{
- struct ieee802_11_elems elems;
- int ht, pri_chan = 0, sec_chan = 0;
- struct ieee80211_ht_operation *oper;
- struct hostapd_neighbor_bss *nnei;
-
- ieee802_11_parse_elems(ie, ie_len, &elems, 0);
- ht = elems.ht_capabilities || elems.ht_operation;
- if (elems.ht_operation && elems.ht_operation_len >= sizeof(*oper)) {
- oper = (struct ieee80211_ht_operation *) elems.ht_operation;
- pri_chan = oper->control_chan;
- if (oper->ht_param & HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH) {
- if (oper->ht_param &
- HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE)
- sec_chan = pri_chan + 4;
- else if (oper->ht_param &
- HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW)
- sec_chan = pri_chan - 4;
- }
- }
-
- wpa_printf(MSG_DEBUG, "nl80211: Neighboring BSS - bssid=" MACSTR
- " freq=%d MHz HT=%d pri_chan=%d sec_chan=%d",
- MAC2STR(bssid), freq, ht, pri_chan, sec_chan);
-
- nnei = os_realloc(drv->neighbors, (drv->num_neighbors + 1) *
- sizeof(struct hostapd_neighbor_bss));
- if (nnei == NULL)
- return;
- drv->neighbors = nnei;
- nnei = &nnei[drv->num_neighbors];
- os_memcpy(nnei->bssid, bssid, ETH_ALEN);
- nnei->freq = freq;
- nnei->ht = !!ht;
- nnei->pri_chan = pri_chan;
- nnei->sec_chan = sec_chan;
- drv->num_neighbors++;
-}
-
-
-static int i802_get_scan_freq(struct iw_event *iwe, int *freq)
-{
- int divi = 1000000, i;
-
- if (iwe->u.freq.e == 0) {
- /*
- * Some drivers do not report frequency, but a channel.
- * Try to map this to frequency by assuming they are using
- * IEEE 802.11b/g. But don't overwrite a previously parsed
- * frequency if the driver sends both frequency and channel,
- * since the driver may be sending an A-band channel that we
- * don't handle here.
- */
-
- if (*freq)
- return 0;
-
- if (iwe->u.freq.m >= 1 && iwe->u.freq.m <= 13) {
- *freq = 2407 + 5 * iwe->u.freq.m;
- return 0;
- } else if (iwe->u.freq.m == 14) {
- *freq = 2484;
- return 0;
- }
- }
-
- if (iwe->u.freq.e > 6) {
- wpa_printf(MSG_DEBUG, "Invalid freq in scan results: "
- "m=%d e=%d", iwe->u.freq.m, iwe->u.freq.e);
- return -1;
- }
-
- for (i = 0; i < iwe->u.freq.e; i++)
- divi /= 10;
- *freq = iwe->u.freq.m / divi;
- return 0;
-}
-
-
-static int i802_parse_scan(struct wpa_driver_nl80211_data *drv, u8 *res_buf,
- size_t len)
-{
- size_t ap_num = 0;
- int first;
- struct iw_event iwe_buf, *iwe = &iwe_buf;
- char *pos, *end, *custom;
- u8 bssid[ETH_ALEN];
- int freq = 0;
- u8 *ie = NULL;
- size_t ie_len = 0;
-
- ap_num = 0;
- first = 1;
-
- pos = (char *) res_buf;
- end = (char *) res_buf + len;
-
- while (pos + IW_EV_LCP_LEN <= end) {
- /* Event data may be unaligned, so make a local, aligned copy
- * before processing. */
- os_memcpy(&iwe_buf, pos, IW_EV_LCP_LEN);
- if (iwe->len <= IW_EV_LCP_LEN)
- break;
-
- custom = pos + IW_EV_POINT_LEN;
- if (iwe->cmd == IWEVGENIE) {
- /* WE-19 removed the pointer from struct iw_point */
- char *dpos = (char *) &iwe_buf.u.data.length;
- int dlen = dpos - (char *) &iwe_buf;
- os_memcpy(dpos, pos + IW_EV_LCP_LEN,
- sizeof(struct iw_event) - dlen);
- } else {
- os_memcpy(&iwe_buf, pos, sizeof(struct iw_event));
- custom += IW_EV_POINT_OFF;
- }
-
- switch (iwe->cmd) {
- case SIOCGIWAP:
- if (!first)
- i802_add_neighbor(drv, bssid, freq, ie,
- ie_len);
- first = 0;
- os_memcpy(bssid, iwe->u.ap_addr.sa_data, ETH_ALEN);
- freq = 0;
- ie = NULL;
- ie_len = 0;
- break;
- case SIOCGIWFREQ:
- i802_get_scan_freq(iwe, &freq);
- break;
- case IWEVGENIE:
- if (custom + iwe->u.data.length > end) {
- wpa_printf(MSG_ERROR, "IWEVGENIE overflow");
- return -1;
- }
- ie = (u8 *) custom;
- ie_len = iwe->u.data.length;
- break;
- }
-
- pos += iwe->len;
- }
-
- if (!first)
- i802_add_neighbor(drv, bssid, freq, ie, ie_len);
-
- return 0;
-}
-
-
-static int i802_get_ht_scan_res(struct wpa_driver_nl80211_data *drv)
-{
- struct iwreq iwr;
- u8 *res_buf;
- size_t res_buf_len;
- int res;
-
- res_buf_len = IW_SCAN_MAX_DATA;
- for (;;) {
- res_buf = os_malloc(res_buf_len);
- if (res_buf == NULL)
- return -1;
- os_memset(&iwr, 0, sizeof(iwr));
- os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
- iwr.u.data.pointer = res_buf;
- iwr.u.data.length = res_buf_len;
-
- if (ioctl(drv->ioctl_sock, SIOCGIWSCAN, &iwr) == 0)
- break;
-
- if (errno == E2BIG && res_buf_len < 65535) {
- os_free(res_buf);
- res_buf = NULL;
- res_buf_len *= 2;
- if (res_buf_len > 65535)
- res_buf_len = 65535; /* 16-bit length field */
- wpa_printf(MSG_DEBUG, "Scan results did not fit - "
- "trying larger buffer (%lu bytes)",
- (unsigned long) res_buf_len);
- } else {
- perror("ioctl[SIOCGIWSCAN]");
- os_free(res_buf);
- return -1;
- }
- }
-
- if (iwr.u.data.length > res_buf_len) {
- os_free(res_buf);
- return -1;
- }
-
- res = i802_parse_scan(drv, res_buf, iwr.u.data.length);
- os_free(res_buf);
-
- return res;
-}
-
-
-static int i802_is_event_wireless_scan_complete(char *data, int len)
-{
- struct iw_event iwe_buf, *iwe = &iwe_buf;
- char *pos, *end;
-
- pos = data;
- end = data + len;
-
- while (pos + IW_EV_LCP_LEN <= end) {
- /* Event data may be unaligned, so make a local, aligned copy
- * before processing. */
- os_memcpy(&iwe_buf, pos, IW_EV_LCP_LEN);
- if (iwe->cmd == SIOCGIWSCAN)
- return 1;
-
- pos += iwe->len;
- }
-
- return 0;
-}
-
-
-static int i802_is_rtm_scan_complete(int ifindex, struct nlmsghdr *h, int len)
-{
- struct ifinfomsg *ifi;
- int attrlen, _nlmsg_len, rta_len;
- struct rtattr *attr;
-
- if (len < (int) sizeof(*ifi))
- return 0;
-
- ifi = NLMSG_DATA(h);
-
- if (ifindex != ifi->ifi_index)
- return 0; /* event for foreign ifindex */
-
- _nlmsg_len = NLMSG_ALIGN(sizeof(struct ifinfomsg));
-
- attrlen = h->nlmsg_len - _nlmsg_len;
- if (attrlen < 0)
- return 0;
-
- attr = (struct rtattr *) (((char *) ifi) + _nlmsg_len);
-
- rta_len = RTA_ALIGN(sizeof(struct rtattr));
- while (RTA_OK(attr, attrlen)) {
- if (attr->rta_type == IFLA_WIRELESS &&
- i802_is_event_wireless_scan_complete(
- ((char *) attr) + rta_len,
- attr->rta_len - rta_len))
- return 1;
- attr = RTA_NEXT(attr, attrlen);
- }
-
- return 0;
-}
-
-
-static int i802_is_scan_complete(int s, int ifindex)
-{
- char buf[1024];
- int left;
- struct nlmsghdr *h;
-
- left = recv(s, buf, sizeof(buf), MSG_DONTWAIT);
- if (left < 0) {
- perror("recv(netlink)");
- return 0;
- }
-
- h = (struct nlmsghdr *) buf;
- while (left >= (int) sizeof(*h)) {
- int len, plen;
-
- len = h->nlmsg_len;
- plen = len - sizeof(*h);
- if (len > left || plen < 0) {
- wpa_printf(MSG_DEBUG, "Malformed netlink message: "
- "len=%d left=%d plen=%d",
- len, left, plen);
- break;
- }
-
- switch (h->nlmsg_type) {
- case RTM_NEWLINK:
- if (i802_is_rtm_scan_complete(ifindex, h, plen))
- return 1;
- break;
- }
-
- len = NLMSG_ALIGN(len);
- left -= len;
- h = (struct nlmsghdr *) ((char *) h + len);
- }
-
- return 0;
-}
-
-
-static int i802_ht_scan(struct wpa_driver_nl80211_data *drv)
-{
- struct iwreq iwr;
- int s, res, ifindex;
- struct sockaddr_nl local;
- time_t now, end;
- fd_set rfds;
- struct timeval tv;
-
- wpa_printf(MSG_DEBUG, "nl80211: Scanning overlapping BSSes before "
- "starting HT 20/40 MHz BSS");
-
- /* Request a new scan */
- /* TODO: would be enough to scan the selected band */
- os_memset(&iwr, 0, sizeof(iwr));
- os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
- if (ioctl(drv->ioctl_sock, SIOCSIWSCAN, &iwr) < 0) {
- perror("ioctl[SIOCSIWSCAN]");
- return -1;
- }
-
- ifindex = if_nametoindex(drv->ifname);
-
- /* Wait for scan completion event or timeout */
- s = socket(PF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
- if (s < 0) {
- perror("socket(PF_NETLINK,SOCK_RAW,NETLINK_ROUTE)");
- return -1;
- }
-
- os_memset(&local, 0, sizeof(local));
- local.nl_family = AF_NETLINK;
- local.nl_groups = RTMGRP_LINK;
- if (bind(s, (struct sockaddr *) &local, sizeof(local)) < 0) {
- perror("bind(netlink)");
- close(s);
- return -1;
- }
-
- time(&end);
- end += 30; /* Wait at most 30 seconds for scan results */
- for (;;) {
- time(&now);
- tv.tv_sec = end > now ? end - now : 0;
- tv.tv_usec = 0;
- FD_ZERO(&rfds);
- FD_SET(s, &rfds);
- res = select(s + 1, &rfds, NULL, NULL, &tv);
- if (res < 0) {
- perror("select");
- /* Assume results are ready after 10 seconds wait */
- os_sleep(10, 0);
- break;
- } else if (res) {
- if (i802_is_scan_complete(s, ifindex)) {
- wpa_printf(MSG_DEBUG, "nl80211: Scan "
- "completed");
- break;
- }
- } else {
- wpa_printf(MSG_DEBUG, "nl80211: Scan timeout");
- /* Assume results are ready to be read now */
- break;
- }
- }
-
- close(s);
-
- return i802_get_ht_scan_res(drv);
-}
-#endif /* CONFIG_IEEE80211N */
-
-
-static int i802_init_sockets(struct wpa_driver_nl80211_data *drv, const u8 *bssid)
-{
- struct ifreq ifr;
-
- drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0);
- if (drv->ioctl_sock < 0) {
- perror("socket[PF_INET,SOCK_DGRAM]");
- return -1;
- }
-
- /* start listening for EAPOL on the default AP interface */
- add_ifidx(drv, if_nametoindex(drv->ifname));
-
- if (hostapd_set_iface_flags(drv, drv->ifname, 0))
- return -1;
-
- if (bssid) {
- os_strlcpy(ifr.ifr_name, drv->ifname, IFNAMSIZ);
- memcpy(ifr.ifr_hwaddr.sa_data, bssid, ETH_ALEN);
- ifr.ifr_hwaddr.sa_family = ARPHRD_ETHER;
-
- if (ioctl(drv->ioctl_sock, SIOCSIFHWADDR, &ifr)) {
- perror("ioctl(SIOCSIFHWADDR)");
- return -1;
- }
- }
-
- if (wpa_driver_nl80211_init_nl(drv, drv->hapd))
- return -1;
-
-#ifdef CONFIG_IEEE80211N
- if (drv->ht_40mhz_scan) {
- if (nl80211_set_mode(drv, drv->ifname, NL80211_IFTYPE_STATION)
- || hostapd_set_iface_flags(drv, drv->ifname, 1) ||
- i802_ht_scan(drv) ||
- hostapd_set_iface_flags(drv, drv->ifname, 0)) {
- wpa_printf(MSG_ERROR, "Failed to scan channels for "
- "HT 40 MHz operations");
- return -1;
- }
- }
-#endif /* CONFIG_IEEE80211N */
-
- /* Initialise a monitor interface */
- if (nl80211_create_monitor_interface(drv))
- return -1;
-
- if (nl80211_set_mode(drv, drv->ifname, NL80211_IFTYPE_AP))
- goto fail1;
-
- if (hostapd_set_iface_flags(drv, drv->ifname, 1))
- goto fail1;
-
- drv->eapol_sock = socket(PF_PACKET, SOCK_DGRAM, htons(ETH_P_PAE));
- if (drv->eapol_sock < 0) {
- perror("socket(PF_PACKET, SOCK_DGRAM, ETH_P_PAE)");
- goto fail1;
- }
-
- if (eloop_register_read_sock(drv->eapol_sock, handle_eapol, drv, NULL))
- {
- printf("Could not register read socket for eapol\n");
- return -1;
- }
-
- memset(&ifr, 0, sizeof(ifr));
- os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
- if (ioctl(drv->ioctl_sock, SIOCGIFHWADDR, &ifr) != 0) {
- perror("ioctl(SIOCGIFHWADDR)");
- goto fail1;
- }
-
- if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
- printf("Invalid HW-addr family 0x%04x\n",
- ifr.ifr_hwaddr.sa_family);
- goto fail1;
- }
- memcpy(drv->hapd->own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
-
- return 0;
-
-fail1:
- nl80211_remove_iface(drv, drv->monitor_ifidx);
- return -1;
-}
-
-
static int i802_get_inact_sec(void *priv, const u8 *addr)
{
struct hostap_sta_driver_data data;
}
-static const struct hostapd_neighbor_bss *
-i802_get_neighbor_bss(void *priv, size_t *num)
-{
- struct wpa_driver_nl80211_data *drv = priv;
- *num = drv->num_neighbors;
- return drv->neighbors;
-}
-
-
static void *i802_init(struct hostapd_data *hapd,
struct wpa_init_params *params)
{
struct wpa_driver_nl80211_data *drv;
size_t i;
+ struct ifreq ifr;
drv = os_zalloc(sizeof(struct wpa_driver_nl80211_data));
if (drv == NULL) {
}
drv->hapd = hapd;
+ drv->ctx = hapd;
memcpy(drv->ifname, params->ifname, sizeof(drv->ifname));
drv->ifindex = if_nametoindex(drv->ifname);
drv->bss.ifindex = drv->ifindex;
if (params->bridge[i])
add_ifidx(drv, if_nametoindex(params->bridge[i]));
}
- drv->ht_40mhz_scan = params->ht_40mhz_scan;
- if (i802_init_sockets(drv, params->bssid))
+ drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0);
+ if (drv->ioctl_sock < 0) {
+ perror("socket[PF_INET,SOCK_DGRAM]");
+ goto failed;
+ }
+
+ /* start listening for EAPOL on the default AP interface */
+ add_ifidx(drv, drv->ifindex);
+
+ if (hostapd_set_iface_flags(drv, drv->ifname, 0))
+ goto failed;
+
+ if (params->bssid) {
+ os_strlcpy(ifr.ifr_name, drv->ifname, IFNAMSIZ);
+ os_memcpy(ifr.ifr_hwaddr.sa_data, params->bssid, ETH_ALEN);
+ ifr.ifr_hwaddr.sa_family = ARPHRD_ETHER;
+
+ if (ioctl(drv->ioctl_sock, SIOCSIFHWADDR, &ifr)) {
+ perror("ioctl(SIOCSIFHWADDR)");
+ goto failed;
+ }
+ }
+
+ if (wpa_driver_nl80211_init_nl(drv, drv->hapd))
+ goto failed;
+
+ /* Initialise a monitor interface */
+ if (nl80211_create_monitor_interface(drv))
+ goto failed;
+
+ if (nl80211_set_mode(drv, drv->ifindex, NL80211_IFTYPE_AP)) {
+ wpa_printf(MSG_ERROR, "nl80211: Failed to set interface %s "
+ "into AP mode", drv->ifname);
+ goto fail1;
+ }
+
+ if (hostapd_set_iface_flags(drv, drv->ifname, 1))
+ goto fail1;
+
+ drv->eapol_sock = socket(PF_PACKET, SOCK_DGRAM, htons(ETH_P_PAE));
+ if (drv->eapol_sock < 0) {
+ perror("socket(PF_PACKET, SOCK_DGRAM, ETH_P_PAE)");
+ goto fail1;
+ }
+
+ if (eloop_register_read_sock(drv->eapol_sock, handle_eapol, drv, NULL))
+ {
+ printf("Could not register read socket for eapol\n");
goto failed;
+ }
+
+ os_memset(&ifr, 0, sizeof(ifr));
+ os_strlcpy(ifr.ifr_name, drv->ifname, sizeof(ifr.ifr_name));
+ if (ioctl(drv->ioctl_sock, SIOCGIFHWADDR, &ifr) != 0) {
+ perror("ioctl(SIOCGIFHWADDR)");
+ goto fail1;
+ }
+
+ if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
+ printf("Invalid HW-addr family 0x%04x\n",
+ ifr.ifr_hwaddr.sa_family);
+ goto fail1;
+ }
+ os_memcpy(drv->hapd->own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
return drv;
+fail1:
+ nl80211_remove_iface(drv, drv->monitor_ifidx);
failed:
free(drv);
return NULL;
if (drv->if_indices != drv->default_if_indices)
free(drv->if_indices);
- os_free(drv->neighbors);
-
bss = drv->bss.next;
while (bss) {
prev = bss;
.get_capa = wpa_driver_nl80211_get_capa,
.set_operstate = wpa_driver_nl80211_set_operstate,
.set_country = wpa_driver_nl80211_set_country,
+ .set_mode = wpa_driver_nl80211_set_mode,
#ifdef CONFIG_AP
.set_beacon = wpa_driver_nl80211_set_beacon,
#endif /* CONFIG_AP */
.if_update = i802_if_update,
.if_remove = i802_if_remove,
.set_sta_vlan = i802_set_sta_vlan,
- .get_neighbor_bss = i802_get_neighbor_bss,
#endif /* HOSTAPD */
};
projects / wpasupplicant / commitdiff