253 lines
6.6 KiB
C
253 lines
6.6 KiB
C
/*
|
|
* Marvell Wireless LAN device driver: AP event handling
|
|
*
|
|
* Copyright (C) 2012, Marvell International Ltd.
|
|
*
|
|
* This software file (the "File") is distributed by Marvell International
|
|
* Ltd. under the terms of the GNU General Public License Version 2, June 1991
|
|
* (the "License"). You may use, redistribute and/or modify this File in
|
|
* accordance with the terms and conditions of the License, a copy of which
|
|
* is available by writing to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
|
|
* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
|
|
*
|
|
* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
|
|
* this warranty disclaimer.
|
|
*/
|
|
|
|
#include "decl.h"
|
|
#include "main.h"
|
|
|
|
/*
|
|
* This function will return the pointer to station entry in station list
|
|
* table which matches specified mac address.
|
|
* This function should be called after acquiring RA list spinlock.
|
|
* NULL is returned if station entry is not found in associated STA list.
|
|
*/
|
|
struct mwifiex_sta_node *
|
|
mwifiex_get_sta_entry(struct mwifiex_private *priv, u8 *mac)
|
|
{
|
|
struct mwifiex_sta_node *node;
|
|
|
|
if (!mac)
|
|
return NULL;
|
|
|
|
list_for_each_entry(node, &priv->sta_list, list) {
|
|
if (!memcmp(node->mac_addr, mac, ETH_ALEN))
|
|
return node;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/*
|
|
* This function will add a sta_node entry to associated station list
|
|
* table with the given mac address.
|
|
* If entry exist already, existing entry is returned.
|
|
* If received mac address is NULL, NULL is returned.
|
|
*/
|
|
static struct mwifiex_sta_node *
|
|
mwifiex_add_sta_entry(struct mwifiex_private *priv, u8 *mac)
|
|
{
|
|
struct mwifiex_sta_node *node;
|
|
unsigned long flags;
|
|
|
|
if (!mac)
|
|
return NULL;
|
|
|
|
spin_lock_irqsave(&priv->sta_list_spinlock, flags);
|
|
node = mwifiex_get_sta_entry(priv, mac);
|
|
if (node)
|
|
goto done;
|
|
|
|
node = kzalloc(sizeof(struct mwifiex_sta_node), GFP_KERNEL);
|
|
if (!node)
|
|
goto done;
|
|
|
|
memcpy(node->mac_addr, mac, ETH_ALEN);
|
|
list_add_tail(&node->list, &priv->sta_list);
|
|
|
|
done:
|
|
spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
|
|
return node;
|
|
}
|
|
|
|
/*
|
|
* This function will search for HT IE in association request IEs
|
|
* and set station HT parameters accordingly.
|
|
*/
|
|
static void
|
|
mwifiex_set_sta_ht_cap(struct mwifiex_private *priv, const u8 *ies,
|
|
int ies_len, struct mwifiex_sta_node *node)
|
|
{
|
|
const struct ieee80211_ht_cap *ht_cap;
|
|
|
|
if (!ies)
|
|
return;
|
|
|
|
ht_cap = (void *)cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
|
|
if (ht_cap) {
|
|
node->is_11n_enabled = 1;
|
|
node->max_amsdu = le16_to_cpu(ht_cap->cap_info) &
|
|
IEEE80211_HT_CAP_MAX_AMSDU ?
|
|
MWIFIEX_TX_DATA_BUF_SIZE_8K :
|
|
MWIFIEX_TX_DATA_BUF_SIZE_4K;
|
|
} else {
|
|
node->is_11n_enabled = 0;
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* This function will delete a station entry from station list
|
|
*/
|
|
static void mwifiex_del_sta_entry(struct mwifiex_private *priv, u8 *mac)
|
|
{
|
|
struct mwifiex_sta_node *node, *tmp;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&priv->sta_list_spinlock, flags);
|
|
|
|
node = mwifiex_get_sta_entry(priv, mac);
|
|
if (node) {
|
|
list_for_each_entry_safe(node, tmp, &priv->sta_list,
|
|
list) {
|
|
list_del(&node->list);
|
|
kfree(node);
|
|
}
|
|
}
|
|
|
|
spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* This function will delete all stations from associated station list.
|
|
*/
|
|
static void mwifiex_del_all_sta_list(struct mwifiex_private *priv)
|
|
{
|
|
struct mwifiex_sta_node *node, *tmp;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&priv->sta_list_spinlock, flags);
|
|
|
|
list_for_each_entry_safe(node, tmp, &priv->sta_list, list) {
|
|
list_del(&node->list);
|
|
kfree(node);
|
|
}
|
|
|
|
INIT_LIST_HEAD(&priv->sta_list);
|
|
spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* This function handles AP interface specific events generated by firmware.
|
|
*
|
|
* Event specific routines are called by this function based
|
|
* upon the generated event cause.
|
|
*
|
|
*
|
|
* Events supported for AP -
|
|
* - EVENT_UAP_STA_ASSOC
|
|
* - EVENT_UAP_STA_DEAUTH
|
|
* - EVENT_UAP_BSS_ACTIVE
|
|
* - EVENT_UAP_BSS_START
|
|
* - EVENT_UAP_BSS_IDLE
|
|
* - EVENT_UAP_MIC_COUNTERMEASURES:
|
|
*/
|
|
int mwifiex_process_uap_event(struct mwifiex_private *priv)
|
|
{
|
|
struct mwifiex_adapter *adapter = priv->adapter;
|
|
int len, i;
|
|
u32 eventcause = adapter->event_cause;
|
|
struct station_info sinfo;
|
|
struct mwifiex_assoc_event *event;
|
|
struct mwifiex_sta_node *node;
|
|
u8 *deauth_mac;
|
|
|
|
switch (eventcause) {
|
|
case EVENT_UAP_STA_ASSOC:
|
|
memset(&sinfo, 0, sizeof(sinfo));
|
|
event = (struct mwifiex_assoc_event *)
|
|
(adapter->event_body + MWIFIEX_UAP_EVENT_EXTRA_HEADER);
|
|
if (le16_to_cpu(event->type) == TLV_TYPE_UAP_MGMT_FRAME) {
|
|
len = -1;
|
|
|
|
if (ieee80211_is_assoc_req(event->frame_control))
|
|
len = 0;
|
|
else if (ieee80211_is_reassoc_req(event->frame_control))
|
|
/* There will be ETH_ALEN bytes of
|
|
* current_ap_addr before the re-assoc ies.
|
|
*/
|
|
len = ETH_ALEN;
|
|
|
|
if (len != -1) {
|
|
sinfo.filled = STATION_INFO_ASSOC_REQ_IES;
|
|
sinfo.assoc_req_ies = &event->data[len];
|
|
len = (u8 *)sinfo.assoc_req_ies -
|
|
(u8 *)&event->frame_control;
|
|
sinfo.assoc_req_ies_len =
|
|
le16_to_cpu(event->len) - (u16)len;
|
|
}
|
|
}
|
|
cfg80211_new_sta(priv->netdev, event->sta_addr, &sinfo,
|
|
GFP_KERNEL);
|
|
|
|
node = mwifiex_add_sta_entry(priv, event->sta_addr);
|
|
if (!node) {
|
|
dev_warn(adapter->dev,
|
|
"could not create station entry!\n");
|
|
return -1;
|
|
}
|
|
|
|
if (!priv->ap_11n_enabled)
|
|
break;
|
|
|
|
mwifiex_set_sta_ht_cap(priv, sinfo.assoc_req_ies,
|
|
sinfo.assoc_req_ies_len, node);
|
|
|
|
for (i = 0; i < MAX_NUM_TID; i++) {
|
|
if (node->is_11n_enabled)
|
|
node->ampdu_sta[i] =
|
|
priv->aggr_prio_tbl[i].ampdu_user;
|
|
else
|
|
node->ampdu_sta[i] = BA_STREAM_NOT_ALLOWED;
|
|
}
|
|
memset(node->rx_seq, 0xff, sizeof(node->rx_seq));
|
|
break;
|
|
case EVENT_UAP_STA_DEAUTH:
|
|
deauth_mac = adapter->event_body +
|
|
MWIFIEX_UAP_EVENT_EXTRA_HEADER;
|
|
cfg80211_del_sta(priv->netdev, deauth_mac, GFP_KERNEL);
|
|
|
|
mwifiex_del_sta_entry(priv, deauth_mac);
|
|
break;
|
|
case EVENT_UAP_BSS_IDLE:
|
|
priv->media_connected = false;
|
|
mwifiex_del_all_sta_list(priv);
|
|
break;
|
|
case EVENT_UAP_BSS_ACTIVE:
|
|
priv->media_connected = true;
|
|
break;
|
|
case EVENT_UAP_BSS_START:
|
|
dev_dbg(adapter->dev, "AP EVENT: event id: %#x\n", eventcause);
|
|
memcpy(priv->netdev->dev_addr, adapter->event_body + 2,
|
|
ETH_ALEN);
|
|
break;
|
|
case EVENT_UAP_MIC_COUNTERMEASURES:
|
|
/* For future development */
|
|
dev_dbg(adapter->dev, "AP EVENT: event id: %#x\n", eventcause);
|
|
break;
|
|
default:
|
|
dev_dbg(adapter->dev, "event: unknown event id: %#x\n",
|
|
eventcause);
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|