448 lines
14 KiB
C
448 lines
14 KiB
C
/*
|
|
* wpa_supplicant - Off-channel Action frame TX/RX
|
|
* Copyright (c) 2009-2010, Atheros Communications
|
|
* Copyright (c) 2011, Qualcomm Atheros
|
|
*
|
|
* This software may be distributed under the terms of the BSD license.
|
|
* See README for more details.
|
|
*/
|
|
|
|
#include "includes.h"
|
|
|
|
#include "common.h"
|
|
#include "utils/eloop.h"
|
|
#include "wpa_supplicant_i.h"
|
|
#include "p2p_supplicant.h"
|
|
#include "driver_i.h"
|
|
#include "offchannel.h"
|
|
|
|
|
|
|
|
static struct wpa_supplicant *
|
|
wpas_get_tx_interface(struct wpa_supplicant *wpa_s, const u8 *src)
|
|
{
|
|
struct wpa_supplicant *iface;
|
|
|
|
if (os_memcmp(src, wpa_s->own_addr, ETH_ALEN) == 0)
|
|
return wpa_s;
|
|
|
|
/*
|
|
* Try to find a group interface that matches with the source address.
|
|
*/
|
|
iface = wpa_s->global->ifaces;
|
|
while (iface) {
|
|
if (os_memcmp(src, iface->own_addr, ETH_ALEN) == 0)
|
|
break;
|
|
iface = iface->next;
|
|
}
|
|
if (iface) {
|
|
wpa_printf(MSG_DEBUG, "P2P: Use group interface %s "
|
|
"instead of interface %s for Action TX",
|
|
iface->ifname, wpa_s->ifname);
|
|
return iface;
|
|
}
|
|
|
|
return wpa_s;
|
|
}
|
|
|
|
|
|
static void wpas_send_action_cb(void *eloop_ctx, void *timeout_ctx)
|
|
{
|
|
struct wpa_supplicant *wpa_s = eloop_ctx;
|
|
struct wpa_supplicant *iface;
|
|
int res;
|
|
int without_roc;
|
|
|
|
without_roc = wpa_s->pending_action_without_roc;
|
|
wpa_s->pending_action_without_roc = 0;
|
|
wpa_printf(MSG_DEBUG,
|
|
"Off-channel: Send Action callback (without_roc=%d pending_action_tx=%p pending_action_tx_done=%d)",
|
|
without_roc, wpa_s->pending_action_tx,
|
|
!!wpa_s->pending_action_tx_done);
|
|
|
|
if (wpa_s->pending_action_tx == NULL || wpa_s->pending_action_tx_done)
|
|
return;
|
|
|
|
/*
|
|
* This call is likely going to be on the P2P device instance if the
|
|
* driver uses a separate interface for that purpose. However, some
|
|
* Action frames are actually sent within a P2P Group and when that is
|
|
* the case, we need to follow power saving (e.g., GO buffering the
|
|
* frame for a client in PS mode or a client following the advertised
|
|
* NoA from its GO). To make that easier for the driver, select the
|
|
* correct group interface here.
|
|
*/
|
|
iface = wpas_get_tx_interface(wpa_s, wpa_s->pending_action_src);
|
|
|
|
if (wpa_s->off_channel_freq != wpa_s->pending_action_freq &&
|
|
wpa_s->pending_action_freq != 0 &&
|
|
wpa_s->pending_action_freq != iface->assoc_freq) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Pending Action frame TX "
|
|
"waiting for another freq=%u (off_channel_freq=%u "
|
|
"assoc_freq=%u)",
|
|
wpa_s->pending_action_freq,
|
|
wpa_s->off_channel_freq,
|
|
iface->assoc_freq);
|
|
if (without_roc && wpa_s->off_channel_freq == 0) {
|
|
unsigned int duration = 200;
|
|
/*
|
|
* We may get here if wpas_send_action() found us to be
|
|
* on the correct channel, but remain-on-channel cancel
|
|
* event was received before getting here.
|
|
*/
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Schedule "
|
|
"remain-on-channel to send Action frame");
|
|
#ifdef CONFIG_TESTING_OPTIONS
|
|
if (wpa_s->extra_roc_dur) {
|
|
wpa_printf(MSG_DEBUG,
|
|
"TESTING: Increase ROC duration %u -> %u",
|
|
duration,
|
|
duration + wpa_s->extra_roc_dur);
|
|
duration += wpa_s->extra_roc_dur;
|
|
}
|
|
#endif /* CONFIG_TESTING_OPTIONS */
|
|
if (wpa_drv_remain_on_channel(
|
|
wpa_s, wpa_s->pending_action_freq,
|
|
duration) < 0) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Failed to "
|
|
"request driver to remain on "
|
|
"channel (%u MHz) for Action Frame "
|
|
"TX", wpa_s->pending_action_freq);
|
|
} else {
|
|
wpa_s->off_channel_freq = 0;
|
|
wpa_s->roc_waiting_drv_freq =
|
|
wpa_s->pending_action_freq;
|
|
}
|
|
}
|
|
return;
|
|
}
|
|
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Sending pending Action frame to "
|
|
MACSTR " using interface %s",
|
|
MAC2STR(wpa_s->pending_action_dst), iface->ifname);
|
|
res = wpa_drv_send_action(iface, wpa_s->pending_action_freq, 0,
|
|
wpa_s->pending_action_dst,
|
|
wpa_s->pending_action_src,
|
|
wpa_s->pending_action_bssid,
|
|
wpabuf_head(wpa_s->pending_action_tx),
|
|
wpabuf_len(wpa_s->pending_action_tx),
|
|
wpa_s->pending_action_no_cck);
|
|
if (res) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Failed to send the "
|
|
"pending Action frame");
|
|
/*
|
|
* Use fake TX status event to allow state machines to
|
|
* continue.
|
|
*/
|
|
offchannel_send_action_tx_status(
|
|
wpa_s, wpa_s->pending_action_dst,
|
|
wpabuf_head(wpa_s->pending_action_tx),
|
|
wpabuf_len(wpa_s->pending_action_tx),
|
|
OFFCHANNEL_SEND_ACTION_FAILED);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_send_action_tx_status - TX status callback
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
* @dst: Destination MAC address of the transmitted Action frame
|
|
* @data: Transmitted frame payload
|
|
* @data_len: Length of @data in bytes
|
|
* @result: TX status
|
|
*
|
|
* This function is called whenever the driver indicates a TX status event for
|
|
* a frame sent by offchannel_send_action() using wpa_drv_send_action().
|
|
*/
|
|
void offchannel_send_action_tx_status(
|
|
struct wpa_supplicant *wpa_s, const u8 *dst, const u8 *data,
|
|
size_t data_len, enum offchannel_send_action_result result)
|
|
{
|
|
if (wpa_s->pending_action_tx == NULL) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Ignore Action TX status - "
|
|
"no pending operation");
|
|
return;
|
|
}
|
|
|
|
if (os_memcmp(dst, wpa_s->pending_action_dst, ETH_ALEN) != 0) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Ignore Action TX status - "
|
|
"unknown destination address");
|
|
return;
|
|
}
|
|
|
|
/* Accept report only if the contents of the frame matches */
|
|
if (data_len - wpabuf_len(wpa_s->pending_action_tx) != 24 ||
|
|
os_memcmp(data + 24, wpabuf_head(wpa_s->pending_action_tx),
|
|
wpabuf_len(wpa_s->pending_action_tx)) != 0) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Ignore Action TX status - "
|
|
"mismatching contents with pending frame");
|
|
wpa_hexdump(MSG_MSGDUMP, "TX status frame data",
|
|
data, data_len);
|
|
wpa_hexdump_buf(MSG_MSGDUMP, "Pending TX frame",
|
|
wpa_s->pending_action_tx);
|
|
return;
|
|
}
|
|
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Delete matching pending action frame");
|
|
|
|
wpabuf_free(wpa_s->pending_action_tx);
|
|
wpa_s->pending_action_tx = NULL;
|
|
|
|
wpa_printf(MSG_DEBUG, "Off-channel: TX status result=%d cb=%p",
|
|
result, wpa_s->pending_action_tx_status_cb);
|
|
|
|
if (wpa_s->pending_action_tx_status_cb) {
|
|
wpa_s->pending_action_tx_status_cb(
|
|
wpa_s, wpa_s->pending_action_freq,
|
|
wpa_s->pending_action_dst, wpa_s->pending_action_src,
|
|
wpa_s->pending_action_bssid,
|
|
data, data_len, result);
|
|
}
|
|
|
|
#ifdef CONFIG_P2P
|
|
if (wpa_s->p2p_long_listen > 0) {
|
|
/* Continue the listen */
|
|
wpa_printf(MSG_DEBUG, "P2P: Continuing long Listen state");
|
|
wpas_p2p_listen_start(wpa_s, wpa_s->p2p_long_listen);
|
|
}
|
|
#endif /* CONFIG_P2P */
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_send_action - Request off-channel Action frame TX
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
* @freq: The frequency in MHz indicating the channel on which the frame is to
|
|
* transmitted or 0 for the current channel (only if associated)
|
|
* @dst: Action frame destination MAC address
|
|
* @src: Action frame source MAC address
|
|
* @bssid: Action frame BSSID
|
|
* @buf: Frame to transmit starting from the Category field
|
|
* @len: Length of @buf in bytes
|
|
* @wait_time: Wait time for response in milliseconds
|
|
* @tx_cb: Callback function for indicating TX status or %NULL for now callback
|
|
* @no_cck: Whether CCK rates are to be disallowed for TX rate selection
|
|
* Returns: 0 on success or -1 on failure
|
|
*
|
|
* This function is used to request an Action frame to be transmitted on the
|
|
* current operating channel or on another channel (off-channel). The actual
|
|
* frame transmission will be delayed until the driver is ready on the specified
|
|
* channel. The @wait_time parameter can be used to request the driver to remain
|
|
* awake on the channel to wait for a response.
|
|
*/
|
|
int offchannel_send_action(struct wpa_supplicant *wpa_s, unsigned int freq,
|
|
const u8 *dst, const u8 *src, const u8 *bssid,
|
|
const u8 *buf, size_t len, unsigned int wait_time,
|
|
void (*tx_cb)(struct wpa_supplicant *wpa_s,
|
|
unsigned int freq, const u8 *dst,
|
|
const u8 *src, const u8 *bssid,
|
|
const u8 *data, size_t data_len,
|
|
enum offchannel_send_action_result
|
|
result),
|
|
int no_cck)
|
|
{
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Send action frame: freq=%d dst="
|
|
MACSTR " src=" MACSTR " bssid=" MACSTR " len=%d",
|
|
freq, MAC2STR(dst), MAC2STR(src), MAC2STR(bssid),
|
|
(int) len);
|
|
|
|
wpa_s->pending_action_tx_status_cb = tx_cb;
|
|
|
|
if (wpa_s->pending_action_tx) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Dropped pending Action "
|
|
"frame TX to " MACSTR,
|
|
MAC2STR(wpa_s->pending_action_dst));
|
|
wpabuf_free(wpa_s->pending_action_tx);
|
|
}
|
|
wpa_s->pending_action_tx_done = 0;
|
|
wpa_s->pending_action_tx = wpabuf_alloc(len);
|
|
if (wpa_s->pending_action_tx == NULL) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Failed to allocate Action "
|
|
"frame TX buffer (len=%llu)",
|
|
(unsigned long long) len);
|
|
return -1;
|
|
}
|
|
wpabuf_put_data(wpa_s->pending_action_tx, buf, len);
|
|
os_memcpy(wpa_s->pending_action_src, src, ETH_ALEN);
|
|
os_memcpy(wpa_s->pending_action_dst, dst, ETH_ALEN);
|
|
os_memcpy(wpa_s->pending_action_bssid, bssid, ETH_ALEN);
|
|
wpa_s->pending_action_freq = freq;
|
|
wpa_s->pending_action_no_cck = no_cck;
|
|
|
|
if (freq != 0 && wpa_s->drv_flags & WPA_DRIVER_FLAGS_OFFCHANNEL_TX) {
|
|
struct wpa_supplicant *iface;
|
|
int ret;
|
|
|
|
iface = wpas_get_tx_interface(wpa_s, src);
|
|
wpa_s->action_tx_wait_time = wait_time;
|
|
|
|
ret = wpa_drv_send_action(
|
|
iface, wpa_s->pending_action_freq,
|
|
wait_time, wpa_s->pending_action_dst,
|
|
wpa_s->pending_action_src, wpa_s->pending_action_bssid,
|
|
wpabuf_head(wpa_s->pending_action_tx),
|
|
wpabuf_len(wpa_s->pending_action_tx),
|
|
wpa_s->pending_action_no_cck);
|
|
if (ret == 0)
|
|
wpa_s->pending_action_tx_done = 1;
|
|
return ret;
|
|
}
|
|
|
|
if (freq) {
|
|
struct wpa_supplicant *tx_iface;
|
|
tx_iface = wpas_get_tx_interface(wpa_s, src);
|
|
if (tx_iface->assoc_freq == freq) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Already on "
|
|
"requested channel (TX interface operating "
|
|
"channel)");
|
|
freq = 0;
|
|
}
|
|
}
|
|
|
|
if (wpa_s->off_channel_freq == freq || freq == 0) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Already on requested "
|
|
"channel; send Action frame immediately");
|
|
/* TODO: Would there ever be need to extend the current
|
|
* duration on the channel? */
|
|
wpa_s->pending_action_without_roc = 1;
|
|
eloop_cancel_timeout(wpas_send_action_cb, wpa_s, NULL);
|
|
eloop_register_timeout(0, 0, wpas_send_action_cb, wpa_s, NULL);
|
|
return 0;
|
|
}
|
|
wpa_s->pending_action_without_roc = 0;
|
|
|
|
if (wpa_s->roc_waiting_drv_freq == freq) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Already waiting for "
|
|
"driver to get to frequency %u MHz; continue "
|
|
"waiting to send the Action frame", freq);
|
|
return 0;
|
|
}
|
|
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Schedule Action frame to be "
|
|
"transmitted once the driver gets to the requested "
|
|
"channel");
|
|
if (wait_time > wpa_s->max_remain_on_chan)
|
|
wait_time = wpa_s->max_remain_on_chan;
|
|
else if (wait_time == 0)
|
|
wait_time = 20;
|
|
#ifdef CONFIG_TESTING_OPTIONS
|
|
if (wpa_s->extra_roc_dur) {
|
|
wpa_printf(MSG_DEBUG, "TESTING: Increase ROC duration %u -> %u",
|
|
wait_time, wait_time + wpa_s->extra_roc_dur);
|
|
wait_time += wpa_s->extra_roc_dur;
|
|
}
|
|
#endif /* CONFIG_TESTING_OPTIONS */
|
|
if (wpa_drv_remain_on_channel(wpa_s, freq, wait_time) < 0) {
|
|
wpa_printf(MSG_DEBUG, "Off-channel: Failed to request driver "
|
|
"to remain on channel (%u MHz) for Action "
|
|
"Frame TX", freq);
|
|
return -1;
|
|
}
|
|
wpa_s->off_channel_freq = 0;
|
|
wpa_s->roc_waiting_drv_freq = freq;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_send_send_action_done - Notify completion of Action frame sequence
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
*
|
|
* This function can be used to cancel a wait for additional response frames on
|
|
* the channel that was used with offchannel_send_action().
|
|
*/
|
|
void offchannel_send_action_done(struct wpa_supplicant *wpa_s)
|
|
{
|
|
wpa_printf(MSG_DEBUG,
|
|
"Off-channel: Action frame sequence done notification: pending_action_tx=%p drv_offchan_tx=%d action_tx_wait_time=%d off_channel_freq=%d roc_waiting_drv_freq=%d",
|
|
wpa_s->pending_action_tx,
|
|
!!(wpa_s->drv_flags & WPA_DRIVER_FLAGS_OFFCHANNEL_TX),
|
|
wpa_s->action_tx_wait_time, wpa_s->off_channel_freq,
|
|
wpa_s->roc_waiting_drv_freq);
|
|
wpabuf_free(wpa_s->pending_action_tx);
|
|
wpa_s->pending_action_tx = NULL;
|
|
if (wpa_s->drv_flags & WPA_DRIVER_FLAGS_OFFCHANNEL_TX &&
|
|
wpa_s->action_tx_wait_time)
|
|
wpa_drv_send_action_cancel_wait(wpa_s);
|
|
else if (wpa_s->off_channel_freq || wpa_s->roc_waiting_drv_freq) {
|
|
wpa_drv_cancel_remain_on_channel(wpa_s);
|
|
wpa_s->off_channel_freq = 0;
|
|
wpa_s->roc_waiting_drv_freq = 0;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_remain_on_channel_cb - Remain-on-channel callback function
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
* @freq: Frequency (in MHz) of the selected channel
|
|
* @duration: Duration of the remain-on-channel operation in milliseconds
|
|
*
|
|
* This function is called whenever the driver notifies beginning of a
|
|
* remain-on-channel operation.
|
|
*/
|
|
void offchannel_remain_on_channel_cb(struct wpa_supplicant *wpa_s,
|
|
unsigned int freq, unsigned int duration)
|
|
{
|
|
wpa_s->roc_waiting_drv_freq = 0;
|
|
wpa_s->off_channel_freq = freq;
|
|
wpas_send_action_cb(wpa_s, NULL);
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_cancel_remain_on_channel_cb - Remain-on-channel stopped callback
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
* @freq: Frequency (in MHz) of the selected channel
|
|
*
|
|
* This function is called whenever the driver notifies termination of a
|
|
* remain-on-channel operation.
|
|
*/
|
|
void offchannel_cancel_remain_on_channel_cb(struct wpa_supplicant *wpa_s,
|
|
unsigned int freq)
|
|
{
|
|
wpa_s->off_channel_freq = 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_pending_action_tx - Check whether there is a pending Action TX
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
* Returns: Pointer to pending frame or %NULL if no pending operation
|
|
*
|
|
* This function can be used to check whether there is a pending Action frame TX
|
|
* operation. The returned pointer should be used only for checking whether it
|
|
* is %NULL (no pending frame) or to print the pointer value in debug
|
|
* information (i.e., the pointer should not be dereferenced).
|
|
*/
|
|
const void * offchannel_pending_action_tx(struct wpa_supplicant *wpa_s)
|
|
{
|
|
return wpa_s->pending_action_tx;
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_clear_pending_action_tx - Clear pending Action frame TX
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
*/
|
|
void offchannel_clear_pending_action_tx(struct wpa_supplicant *wpa_s)
|
|
{
|
|
wpabuf_free(wpa_s->pending_action_tx);
|
|
wpa_s->pending_action_tx = NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* offchannel_deinit - Deinit off-channel operations
|
|
* @wpa_s: Pointer to wpa_supplicant data
|
|
*
|
|
* This function is used to free up any allocated resources for off-channel
|
|
* operations.
|
|
*/
|
|
void offchannel_deinit(struct wpa_supplicant *wpa_s)
|
|
{
|
|
offchannel_clear_pending_action_tx(wpa_s);
|
|
eloop_cancel_timeout(wpas_send_action_cb, wpa_s, NULL);
|
|
}
|