forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
1903 lines
49 KiB
1903 lines
49 KiB
/* |
|
* Copyright (c) 2010-2011 Atheros Communications Inc. |
|
* |
|
* Permission to use, copy, modify, and/or distribute this software for any |
|
* purpose with or without fee is hereby granted, provided that the above |
|
* copyright notice and this permission notice appear in all copies. |
|
* |
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
|
*/ |
|
|
|
#include "htc.h" |
|
|
|
/*************/ |
|
/* Utilities */ |
|
/*************/ |
|
|
|
/* HACK Alert: Use 11NG for 2.4, use 11NA for 5 */ |
|
static enum htc_phymode ath9k_htc_get_curmode(struct ath9k_htc_priv *priv, |
|
struct ath9k_channel *ichan) |
|
{ |
|
if (IS_CHAN_5GHZ(ichan)) |
|
return HTC_MODE_11NA; |
|
|
|
return HTC_MODE_11NG; |
|
} |
|
|
|
bool ath9k_htc_setpower(struct ath9k_htc_priv *priv, |
|
enum ath9k_power_mode mode) |
|
{ |
|
bool ret; |
|
|
|
mutex_lock(&priv->htc_pm_lock); |
|
ret = ath9k_hw_setpower(priv->ah, mode); |
|
mutex_unlock(&priv->htc_pm_lock); |
|
|
|
return ret; |
|
} |
|
|
|
void ath9k_htc_ps_wakeup(struct ath9k_htc_priv *priv) |
|
{ |
|
mutex_lock(&priv->htc_pm_lock); |
|
if (++priv->ps_usecount != 1) |
|
goto unlock; |
|
ath9k_hw_setpower(priv->ah, ATH9K_PM_AWAKE); |
|
|
|
unlock: |
|
mutex_unlock(&priv->htc_pm_lock); |
|
} |
|
|
|
void ath9k_htc_ps_restore(struct ath9k_htc_priv *priv) |
|
{ |
|
bool reset; |
|
|
|
mutex_lock(&priv->htc_pm_lock); |
|
if (--priv->ps_usecount != 0) |
|
goto unlock; |
|
|
|
if (priv->ps_idle) { |
|
ath9k_hw_setrxabort(priv->ah, true); |
|
ath9k_hw_stopdmarecv(priv->ah, &reset); |
|
ath9k_hw_setpower(priv->ah, ATH9K_PM_FULL_SLEEP); |
|
} else if (priv->ps_enabled) { |
|
ath9k_hw_setpower(priv->ah, ATH9K_PM_NETWORK_SLEEP); |
|
} |
|
|
|
unlock: |
|
mutex_unlock(&priv->htc_pm_lock); |
|
} |
|
|
|
void ath9k_ps_work(struct work_struct *work) |
|
{ |
|
struct ath9k_htc_priv *priv = |
|
container_of(work, struct ath9k_htc_priv, |
|
ps_work); |
|
ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); |
|
|
|
/* The chip wakes up after receiving the first beacon |
|
while network sleep is enabled. For the driver to |
|
be in sync with the hw, set the chip to awake and |
|
only then set it to sleep. |
|
*/ |
|
ath9k_htc_setpower(priv, ATH9K_PM_NETWORK_SLEEP); |
|
} |
|
|
|
static void ath9k_htc_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = data; |
|
struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; |
|
|
|
if ((vif->type == NL80211_IFTYPE_AP || |
|
vif->type == NL80211_IFTYPE_MESH_POINT) && |
|
bss_conf->enable_beacon) { |
|
priv->reconfig_beacon = true; |
|
priv->rearm_ani = true; |
|
} |
|
|
|
if (bss_conf->assoc) { |
|
priv->rearm_ani = true; |
|
priv->reconfig_beacon = true; |
|
} |
|
} |
|
|
|
static void ath9k_htc_vif_reconfig(struct ath9k_htc_priv *priv) |
|
{ |
|
priv->rearm_ani = false; |
|
priv->reconfig_beacon = false; |
|
|
|
ieee80211_iterate_active_interfaces_atomic( |
|
priv->hw, IEEE80211_IFACE_ITER_RESUME_ALL, |
|
ath9k_htc_vif_iter, priv); |
|
if (priv->rearm_ani) |
|
ath9k_htc_start_ani(priv); |
|
|
|
if (priv->reconfig_beacon) { |
|
ath9k_htc_ps_wakeup(priv); |
|
ath9k_htc_beacon_reconfig(priv); |
|
ath9k_htc_ps_restore(priv); |
|
} |
|
} |
|
|
|
static void ath9k_htc_bssid_iter(void *data, u8 *mac, struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_vif_iter_data *iter_data = data; |
|
int i; |
|
|
|
if (iter_data->hw_macaddr != NULL) { |
|
for (i = 0; i < ETH_ALEN; i++) |
|
iter_data->mask[i] &= ~(iter_data->hw_macaddr[i] ^ mac[i]); |
|
} else { |
|
iter_data->hw_macaddr = mac; |
|
} |
|
} |
|
|
|
static void ath9k_htc_set_mac_bssid_mask(struct ath9k_htc_priv *priv, |
|
struct ieee80211_vif *vif) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_vif_iter_data iter_data; |
|
|
|
/* |
|
* Pick the MAC address of the first interface as the new hardware |
|
* MAC address. The hardware will use it together with the BSSID mask |
|
* when matching addresses. |
|
*/ |
|
iter_data.hw_macaddr = NULL; |
|
eth_broadcast_addr(iter_data.mask); |
|
|
|
if (vif) |
|
ath9k_htc_bssid_iter(&iter_data, vif->addr, vif); |
|
|
|
/* Get list of all active MAC addresses */ |
|
ieee80211_iterate_active_interfaces_atomic( |
|
priv->hw, IEEE80211_IFACE_ITER_RESUME_ALL, |
|
ath9k_htc_bssid_iter, &iter_data); |
|
|
|
memcpy(common->bssidmask, iter_data.mask, ETH_ALEN); |
|
|
|
if (iter_data.hw_macaddr) |
|
memcpy(common->macaddr, iter_data.hw_macaddr, ETH_ALEN); |
|
|
|
ath_hw_setbssidmask(common); |
|
} |
|
|
|
static void ath9k_htc_set_opmode(struct ath9k_htc_priv *priv) |
|
{ |
|
if (priv->num_ibss_vif) |
|
priv->ah->opmode = NL80211_IFTYPE_ADHOC; |
|
else if (priv->num_ap_vif) |
|
priv->ah->opmode = NL80211_IFTYPE_AP; |
|
else if (priv->num_mbss_vif) |
|
priv->ah->opmode = NL80211_IFTYPE_MESH_POINT; |
|
else |
|
priv->ah->opmode = NL80211_IFTYPE_STATION; |
|
|
|
ath9k_hw_setopmode(priv->ah); |
|
} |
|
|
|
void ath9k_htc_reset(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_hw *ah = priv->ah; |
|
struct ath_common *common = ath9k_hw_common(ah); |
|
struct ieee80211_channel *channel = priv->hw->conf.chandef.chan; |
|
struct ath9k_hw_cal_data *caldata = NULL; |
|
enum htc_phymode mode; |
|
__be16 htc_mode; |
|
u8 cmd_rsp; |
|
int ret; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
ath9k_htc_stop_ani(priv); |
|
ieee80211_stop_queues(priv->hw); |
|
|
|
del_timer_sync(&priv->tx.cleanup_timer); |
|
ath9k_htc_tx_drain(priv); |
|
|
|
WMI_CMD(WMI_DISABLE_INTR_CMDID); |
|
WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID); |
|
WMI_CMD(WMI_STOP_RECV_CMDID); |
|
|
|
ath9k_wmi_event_drain(priv); |
|
|
|
caldata = &priv->caldata; |
|
ret = ath9k_hw_reset(ah, ah->curchan, caldata, false); |
|
if (ret) { |
|
ath_err(common, |
|
"Unable to reset device (%u Mhz) reset status %d\n", |
|
channel->center_freq, ret); |
|
} |
|
|
|
ath9k_cmn_update_txpow(ah, priv->curtxpow, priv->txpowlimit, |
|
&priv->curtxpow); |
|
|
|
WMI_CMD(WMI_START_RECV_CMDID); |
|
ath9k_host_rx_init(priv); |
|
|
|
mode = ath9k_htc_get_curmode(priv, ah->curchan); |
|
htc_mode = cpu_to_be16(mode); |
|
WMI_CMD_BUF(WMI_SET_MODE_CMDID, &htc_mode); |
|
|
|
WMI_CMD(WMI_ENABLE_INTR_CMDID); |
|
htc_start(priv->htc); |
|
ath9k_htc_vif_reconfig(priv); |
|
ieee80211_wake_queues(priv->hw); |
|
|
|
mod_timer(&priv->tx.cleanup_timer, |
|
jiffies + msecs_to_jiffies(ATH9K_HTC_TX_CLEANUP_INTERVAL)); |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static int ath9k_htc_set_channel(struct ath9k_htc_priv *priv, |
|
struct ieee80211_hw *hw, |
|
struct ath9k_channel *hchan) |
|
{ |
|
struct ath_hw *ah = priv->ah; |
|
struct ath_common *common = ath9k_hw_common(ah); |
|
struct ieee80211_conf *conf = &common->hw->conf; |
|
bool fastcc; |
|
struct ieee80211_channel *channel = hw->conf.chandef.chan; |
|
struct ath9k_hw_cal_data *caldata; |
|
enum htc_phymode mode; |
|
__be16 htc_mode; |
|
u8 cmd_rsp; |
|
int ret; |
|
|
|
if (test_bit(ATH_OP_INVALID, &common->op_flags)) |
|
return -EIO; |
|
|
|
fastcc = !!(hw->conf.flags & IEEE80211_CONF_OFFCHANNEL); |
|
|
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
ath9k_htc_stop_ani(priv); |
|
del_timer_sync(&priv->tx.cleanup_timer); |
|
ath9k_htc_tx_drain(priv); |
|
|
|
WMI_CMD(WMI_DISABLE_INTR_CMDID); |
|
WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID); |
|
WMI_CMD(WMI_STOP_RECV_CMDID); |
|
|
|
ath9k_wmi_event_drain(priv); |
|
|
|
ath_dbg(common, CONFIG, |
|
"(%u MHz) -> (%u MHz), HT: %d, HT40: %d fastcc: %d\n", |
|
priv->ah->curchan->channel, |
|
channel->center_freq, conf_is_ht(conf), conf_is_ht40(conf), |
|
fastcc); |
|
caldata = fastcc ? NULL : &priv->caldata; |
|
ret = ath9k_hw_reset(ah, hchan, caldata, fastcc); |
|
if (ret) { |
|
ath_err(common, |
|
"Unable to reset channel (%u Mhz) reset status %d\n", |
|
channel->center_freq, ret); |
|
goto err; |
|
} |
|
|
|
ath9k_cmn_update_txpow(ah, priv->curtxpow, priv->txpowlimit, |
|
&priv->curtxpow); |
|
|
|
WMI_CMD(WMI_START_RECV_CMDID); |
|
if (ret) |
|
goto err; |
|
|
|
ath9k_host_rx_init(priv); |
|
|
|
mode = ath9k_htc_get_curmode(priv, hchan); |
|
htc_mode = cpu_to_be16(mode); |
|
WMI_CMD_BUF(WMI_SET_MODE_CMDID, &htc_mode); |
|
if (ret) |
|
goto err; |
|
|
|
WMI_CMD(WMI_ENABLE_INTR_CMDID); |
|
if (ret) |
|
goto err; |
|
|
|
htc_start(priv->htc); |
|
|
|
if (!test_bit(ATH_OP_SCANNING, &common->op_flags) && |
|
!(hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)) |
|
ath9k_htc_vif_reconfig(priv); |
|
|
|
mod_timer(&priv->tx.cleanup_timer, |
|
jiffies + msecs_to_jiffies(ATH9K_HTC_TX_CLEANUP_INTERVAL)); |
|
|
|
/* perform spectral scan if requested. */ |
|
if (test_bit(ATH_OP_SCANNING, &common->op_flags) && |
|
priv->spec_priv.spectral_mode == SPECTRAL_CHANSCAN) |
|
ath9k_cmn_spectral_scan_trigger(common, &priv->spec_priv); |
|
err: |
|
ath9k_htc_ps_restore(priv); |
|
return ret; |
|
} |
|
|
|
/* |
|
* Monitor mode handling is a tad complicated because the firmware requires |
|
* an interface to be created exclusively, while mac80211 doesn't associate |
|
* an interface with the mode. |
|
* |
|
* So, for now, only one monitor interface can be configured. |
|
*/ |
|
static void __ath9k_htc_remove_monitor_interface(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_vif hvif; |
|
int ret = 0; |
|
u8 cmd_rsp; |
|
|
|
memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); |
|
memcpy(&hvif.myaddr, common->macaddr, ETH_ALEN); |
|
hvif.index = priv->mon_vif_idx; |
|
WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID, &hvif); |
|
if (ret) { |
|
ath_err(common, "Unable to remove monitor interface at idx: %d\n", |
|
priv->mon_vif_idx); |
|
} |
|
|
|
priv->nvifs--; |
|
priv->vif_slot &= ~(1 << priv->mon_vif_idx); |
|
} |
|
|
|
static int ath9k_htc_add_monitor_interface(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_vif hvif; |
|
struct ath9k_htc_target_sta tsta; |
|
int ret = 0, sta_idx; |
|
u8 cmd_rsp; |
|
|
|
if ((priv->nvifs >= ATH9K_HTC_MAX_VIF) || |
|
(priv->nstations >= ATH9K_HTC_MAX_STA)) { |
|
ret = -ENOBUFS; |
|
goto err_vif; |
|
} |
|
|
|
sta_idx = ffz(priv->sta_slot); |
|
if ((sta_idx < 0) || (sta_idx > ATH9K_HTC_MAX_STA)) { |
|
ret = -ENOBUFS; |
|
goto err_vif; |
|
} |
|
|
|
/* |
|
* Add an interface. |
|
*/ |
|
memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); |
|
memcpy(&hvif.myaddr, common->macaddr, ETH_ALEN); |
|
|
|
hvif.opmode = HTC_M_MONITOR; |
|
hvif.index = ffz(priv->vif_slot); |
|
|
|
WMI_CMD_BUF(WMI_VAP_CREATE_CMDID, &hvif); |
|
if (ret) |
|
goto err_vif; |
|
|
|
/* |
|
* Assign the monitor interface index as a special case here. |
|
* This is needed when the interface is brought down. |
|
*/ |
|
priv->mon_vif_idx = hvif.index; |
|
priv->vif_slot |= (1 << hvif.index); |
|
|
|
/* |
|
* Set the hardware mode to monitor only if there are no |
|
* other interfaces. |
|
*/ |
|
if (!priv->nvifs) |
|
priv->ah->opmode = NL80211_IFTYPE_MONITOR; |
|
|
|
priv->nvifs++; |
|
|
|
/* |
|
* Associate a station with the interface for packet injection. |
|
*/ |
|
memset(&tsta, 0, sizeof(struct ath9k_htc_target_sta)); |
|
|
|
memcpy(&tsta.macaddr, common->macaddr, ETH_ALEN); |
|
|
|
tsta.is_vif_sta = 1; |
|
tsta.sta_index = sta_idx; |
|
tsta.vif_index = hvif.index; |
|
tsta.maxampdu = cpu_to_be16(0xffff); |
|
|
|
WMI_CMD_BUF(WMI_NODE_CREATE_CMDID, &tsta); |
|
if (ret) { |
|
ath_err(common, "Unable to add station entry for monitor mode\n"); |
|
goto err_sta; |
|
} |
|
|
|
priv->sta_slot |= (1 << sta_idx); |
|
priv->nstations++; |
|
priv->vif_sta_pos[priv->mon_vif_idx] = sta_idx; |
|
priv->ah->is_monitoring = true; |
|
|
|
ath_dbg(common, CONFIG, |
|
"Attached a monitor interface at idx: %d, sta idx: %d\n", |
|
priv->mon_vif_idx, sta_idx); |
|
|
|
return 0; |
|
|
|
err_sta: |
|
/* |
|
* Remove the interface from the target. |
|
*/ |
|
__ath9k_htc_remove_monitor_interface(priv); |
|
err_vif: |
|
ath_dbg(common, FATAL, "Unable to attach a monitor interface\n"); |
|
|
|
return ret; |
|
} |
|
|
|
static int ath9k_htc_remove_monitor_interface(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
int ret = 0; |
|
u8 cmd_rsp, sta_idx; |
|
|
|
__ath9k_htc_remove_monitor_interface(priv); |
|
|
|
sta_idx = priv->vif_sta_pos[priv->mon_vif_idx]; |
|
|
|
WMI_CMD_BUF(WMI_NODE_REMOVE_CMDID, &sta_idx); |
|
if (ret) { |
|
ath_err(common, "Unable to remove station entry for monitor mode\n"); |
|
return ret; |
|
} |
|
|
|
priv->sta_slot &= ~(1 << sta_idx); |
|
priv->nstations--; |
|
priv->ah->is_monitoring = false; |
|
|
|
ath_dbg(common, CONFIG, |
|
"Removed a monitor interface at idx: %d, sta idx: %d\n", |
|
priv->mon_vif_idx, sta_idx); |
|
|
|
return 0; |
|
} |
|
|
|
static int ath9k_htc_add_station(struct ath9k_htc_priv *priv, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_sta tsta; |
|
struct ath9k_htc_vif *avp = (struct ath9k_htc_vif *) vif->drv_priv; |
|
struct ath9k_htc_sta *ista; |
|
int ret, sta_idx; |
|
u8 cmd_rsp; |
|
u16 maxampdu; |
|
|
|
if (priv->nstations >= ATH9K_HTC_MAX_STA) |
|
return -ENOBUFS; |
|
|
|
sta_idx = ffz(priv->sta_slot); |
|
if ((sta_idx < 0) || (sta_idx > ATH9K_HTC_MAX_STA)) |
|
return -ENOBUFS; |
|
|
|
memset(&tsta, 0, sizeof(struct ath9k_htc_target_sta)); |
|
|
|
if (sta) { |
|
ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
memcpy(&tsta.macaddr, sta->addr, ETH_ALEN); |
|
memcpy(&tsta.bssid, common->curbssid, ETH_ALEN); |
|
ista->index = sta_idx; |
|
tsta.is_vif_sta = 0; |
|
maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR + |
|
sta->ht_cap.ampdu_factor); |
|
tsta.maxampdu = cpu_to_be16(maxampdu); |
|
} else { |
|
memcpy(&tsta.macaddr, vif->addr, ETH_ALEN); |
|
tsta.is_vif_sta = 1; |
|
tsta.maxampdu = cpu_to_be16(0xffff); |
|
} |
|
|
|
tsta.sta_index = sta_idx; |
|
tsta.vif_index = avp->index; |
|
|
|
WMI_CMD_BUF(WMI_NODE_CREATE_CMDID, &tsta); |
|
if (ret) { |
|
if (sta) |
|
ath_err(common, |
|
"Unable to add station entry for: %pM\n", |
|
sta->addr); |
|
return ret; |
|
} |
|
|
|
if (sta) { |
|
ath_dbg(common, CONFIG, |
|
"Added a station entry for: %pM (idx: %d)\n", |
|
sta->addr, tsta.sta_index); |
|
} else { |
|
ath_dbg(common, CONFIG, |
|
"Added a station entry for VIF %d (idx: %d)\n", |
|
avp->index, tsta.sta_index); |
|
} |
|
|
|
priv->sta_slot |= (1 << sta_idx); |
|
priv->nstations++; |
|
if (!sta) |
|
priv->vif_sta_pos[avp->index] = sta_idx; |
|
|
|
return 0; |
|
} |
|
|
|
static int ath9k_htc_remove_station(struct ath9k_htc_priv *priv, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_vif *avp = (struct ath9k_htc_vif *) vif->drv_priv; |
|
struct ath9k_htc_sta *ista; |
|
int ret; |
|
u8 cmd_rsp, sta_idx; |
|
|
|
if (sta) { |
|
ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
sta_idx = ista->index; |
|
} else { |
|
sta_idx = priv->vif_sta_pos[avp->index]; |
|
} |
|
|
|
WMI_CMD_BUF(WMI_NODE_REMOVE_CMDID, &sta_idx); |
|
if (ret) { |
|
if (sta) |
|
ath_err(common, |
|
"Unable to remove station entry for: %pM\n", |
|
sta->addr); |
|
return ret; |
|
} |
|
|
|
if (sta) { |
|
ath_dbg(common, CONFIG, |
|
"Removed a station entry for: %pM (idx: %d)\n", |
|
sta->addr, sta_idx); |
|
} else { |
|
ath_dbg(common, CONFIG, |
|
"Removed a station entry for VIF %d (idx: %d)\n", |
|
avp->index, sta_idx); |
|
} |
|
|
|
priv->sta_slot &= ~(1 << sta_idx); |
|
priv->nstations--; |
|
|
|
return 0; |
|
} |
|
|
|
int ath9k_htc_update_cap_target(struct ath9k_htc_priv *priv, |
|
u8 enable_coex) |
|
{ |
|
struct ath9k_htc_cap_target tcap; |
|
int ret; |
|
u8 cmd_rsp; |
|
|
|
memset(&tcap, 0, sizeof(struct ath9k_htc_cap_target)); |
|
|
|
tcap.ampdu_limit = cpu_to_be32(0xffff); |
|
tcap.ampdu_subframes = 0xff; |
|
tcap.enable_coex = enable_coex; |
|
tcap.tx_chainmask = priv->ah->caps.tx_chainmask; |
|
|
|
WMI_CMD_BUF(WMI_TARGET_IC_UPDATE_CMDID, &tcap); |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_setup_rate(struct ath9k_htc_priv *priv, |
|
struct ieee80211_sta *sta, |
|
struct ath9k_htc_target_rate *trate) |
|
{ |
|
struct ath9k_htc_sta *ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
struct ieee80211_supported_band *sband; |
|
u32 caps = 0; |
|
int i, j; |
|
|
|
sband = priv->hw->wiphy->bands[priv->hw->conf.chandef.chan->band]; |
|
|
|
for (i = 0, j = 0; i < sband->n_bitrates; i++) { |
|
if (sta->supp_rates[sband->band] & BIT(i)) { |
|
trate->rates.legacy_rates.rs_rates[j] |
|
= (sband->bitrates[i].bitrate * 2) / 10; |
|
j++; |
|
} |
|
} |
|
trate->rates.legacy_rates.rs_nrates = j; |
|
|
|
if (sta->ht_cap.ht_supported) { |
|
for (i = 0, j = 0; i < 77; i++) { |
|
if (sta->ht_cap.mcs.rx_mask[i/8] & (1<<(i%8))) |
|
trate->rates.ht_rates.rs_rates[j++] = i; |
|
if (j == ATH_HTC_RATE_MAX) |
|
break; |
|
} |
|
trate->rates.ht_rates.rs_nrates = j; |
|
|
|
caps = WLAN_RC_HT_FLAG; |
|
if (sta->ht_cap.cap & IEEE80211_HT_CAP_RX_STBC) |
|
caps |= ATH_RC_TX_STBC_FLAG; |
|
if (sta->ht_cap.mcs.rx_mask[1]) |
|
caps |= WLAN_RC_DS_FLAG; |
|
if ((sta->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) && |
|
(conf_is_ht40(&priv->hw->conf))) |
|
caps |= WLAN_RC_40_FLAG; |
|
if (conf_is_ht40(&priv->hw->conf) && |
|
(sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40)) |
|
caps |= WLAN_RC_SGI_FLAG; |
|
else if (conf_is_ht20(&priv->hw->conf) && |
|
(sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20)) |
|
caps |= WLAN_RC_SGI_FLAG; |
|
} |
|
|
|
trate->sta_index = ista->index; |
|
trate->isnew = 1; |
|
trate->capflags = cpu_to_be32(caps); |
|
} |
|
|
|
static int ath9k_htc_send_rate_cmd(struct ath9k_htc_priv *priv, |
|
struct ath9k_htc_target_rate *trate) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
int ret; |
|
u8 cmd_rsp; |
|
|
|
WMI_CMD_BUF(WMI_RC_RATE_UPDATE_CMDID, trate); |
|
if (ret) { |
|
ath_err(common, |
|
"Unable to initialize Rate information on target\n"); |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_init_rate(struct ath9k_htc_priv *priv, |
|
struct ieee80211_sta *sta) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_rate trate; |
|
int ret; |
|
|
|
memset(&trate, 0, sizeof(struct ath9k_htc_target_rate)); |
|
ath9k_htc_setup_rate(priv, sta, &trate); |
|
ret = ath9k_htc_send_rate_cmd(priv, &trate); |
|
if (!ret) |
|
ath_dbg(common, CONFIG, |
|
"Updated target sta: %pM, rate caps: 0x%X\n", |
|
sta->addr, be32_to_cpu(trate.capflags)); |
|
} |
|
|
|
static void ath9k_htc_update_rate(struct ath9k_htc_priv *priv, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_bss_conf *bss_conf) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_rate trate; |
|
struct ieee80211_sta *sta; |
|
int ret; |
|
|
|
memset(&trate, 0, sizeof(struct ath9k_htc_target_rate)); |
|
|
|
rcu_read_lock(); |
|
sta = ieee80211_find_sta(vif, bss_conf->bssid); |
|
if (!sta) { |
|
rcu_read_unlock(); |
|
return; |
|
} |
|
ath9k_htc_setup_rate(priv, sta, &trate); |
|
rcu_read_unlock(); |
|
|
|
ret = ath9k_htc_send_rate_cmd(priv, &trate); |
|
if (!ret) |
|
ath_dbg(common, CONFIG, |
|
"Updated target sta: %pM, rate caps: 0x%X\n", |
|
bss_conf->bssid, be32_to_cpu(trate.capflags)); |
|
} |
|
|
|
static int ath9k_htc_tx_aggr_oper(struct ath9k_htc_priv *priv, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta, |
|
enum ieee80211_ampdu_mlme_action action, |
|
u16 tid) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_aggr aggr; |
|
struct ath9k_htc_sta *ista; |
|
int ret = 0; |
|
u8 cmd_rsp; |
|
|
|
if (tid >= ATH9K_HTC_MAX_TID) |
|
return -EINVAL; |
|
|
|
memset(&aggr, 0, sizeof(struct ath9k_htc_target_aggr)); |
|
ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
|
|
aggr.sta_index = ista->index; |
|
aggr.tidno = tid & 0xf; |
|
aggr.aggr_enable = (action == IEEE80211_AMPDU_TX_START) ? true : false; |
|
|
|
WMI_CMD_BUF(WMI_TX_AGGR_ENABLE_CMDID, &aggr); |
|
if (ret) |
|
ath_dbg(common, CONFIG, |
|
"Unable to %s TX aggregation for (%pM, %d)\n", |
|
(aggr.aggr_enable) ? "start" : "stop", sta->addr, tid); |
|
else |
|
ath_dbg(common, CONFIG, |
|
"%s TX aggregation for (%pM, %d)\n", |
|
(aggr.aggr_enable) ? "Starting" : "Stopping", |
|
sta->addr, tid); |
|
|
|
spin_lock_bh(&priv->tx.tx_lock); |
|
ista->tid_state[tid] = (aggr.aggr_enable && !ret) ? AGGR_START : AGGR_STOP; |
|
spin_unlock_bh(&priv->tx.tx_lock); |
|
|
|
return ret; |
|
} |
|
|
|
/*******/ |
|
/* ANI */ |
|
/*******/ |
|
|
|
void ath9k_htc_start_ani(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
unsigned long timestamp = jiffies_to_msecs(jiffies); |
|
|
|
common->ani.longcal_timer = timestamp; |
|
common->ani.shortcal_timer = timestamp; |
|
common->ani.checkani_timer = timestamp; |
|
|
|
set_bit(ATH_OP_ANI_RUN, &common->op_flags); |
|
|
|
ieee80211_queue_delayed_work(common->hw, &priv->ani_work, |
|
msecs_to_jiffies(ATH_ANI_POLLINTERVAL)); |
|
} |
|
|
|
void ath9k_htc_stop_ani(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
cancel_delayed_work_sync(&priv->ani_work); |
|
clear_bit(ATH_OP_ANI_RUN, &common->op_flags); |
|
} |
|
|
|
void ath9k_htc_ani_work(struct work_struct *work) |
|
{ |
|
struct ath9k_htc_priv *priv = |
|
container_of(work, struct ath9k_htc_priv, ani_work.work); |
|
struct ath_hw *ah = priv->ah; |
|
struct ath_common *common = ath9k_hw_common(ah); |
|
bool longcal = false; |
|
bool shortcal = false; |
|
bool aniflag = false; |
|
unsigned int timestamp = jiffies_to_msecs(jiffies); |
|
u32 cal_interval, short_cal_interval; |
|
|
|
short_cal_interval = (ah->opmode == NL80211_IFTYPE_AP) ? |
|
ATH_AP_SHORT_CALINTERVAL : ATH_STA_SHORT_CALINTERVAL; |
|
|
|
/* Only calibrate if awake */ |
|
if (ah->power_mode != ATH9K_PM_AWAKE) |
|
goto set_timer; |
|
|
|
/* Long calibration runs independently of short calibration. */ |
|
if ((timestamp - common->ani.longcal_timer) >= ATH_LONG_CALINTERVAL) { |
|
longcal = true; |
|
ath_dbg(common, ANI, "longcal @%lu\n", jiffies); |
|
common->ani.longcal_timer = timestamp; |
|
} |
|
|
|
/* |
|
* Short calibration applies only while caldone |
|
* is false or -ETIMEDOUT |
|
*/ |
|
if (common->ani.caldone <= 0) { |
|
if ((timestamp - common->ani.shortcal_timer) >= |
|
short_cal_interval) { |
|
shortcal = true; |
|
ath_dbg(common, ANI, "shortcal @%lu\n", jiffies); |
|
common->ani.shortcal_timer = timestamp; |
|
common->ani.resetcal_timer = timestamp; |
|
} |
|
} else { |
|
if ((timestamp - common->ani.resetcal_timer) >= |
|
ATH_RESTART_CALINTERVAL) { |
|
common->ani.caldone = ath9k_hw_reset_calvalid(ah); |
|
if (common->ani.caldone) |
|
common->ani.resetcal_timer = timestamp; |
|
} |
|
} |
|
|
|
/* Verify whether we must check ANI */ |
|
if ((timestamp - common->ani.checkani_timer) >= ATH_ANI_POLLINTERVAL) { |
|
aniflag = true; |
|
common->ani.checkani_timer = timestamp; |
|
} |
|
|
|
/* Skip all processing if there's nothing to do. */ |
|
if (longcal || shortcal || aniflag) { |
|
|
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
/* Call ANI routine if necessary */ |
|
if (aniflag) |
|
ath9k_hw_ani_monitor(ah, ah->curchan); |
|
|
|
/* Perform calibration if necessary */ |
|
if (longcal || shortcal) |
|
common->ani.caldone = |
|
ath9k_hw_calibrate(ah, ah->curchan, |
|
ah->rxchainmask, longcal) > 0; |
|
|
|
ath9k_htc_ps_restore(priv); |
|
} |
|
|
|
set_timer: |
|
/* |
|
* Set timer interval based on previous results. |
|
* The interval must be the shortest necessary to satisfy ANI, |
|
* short calibration and long calibration. |
|
*/ |
|
cal_interval = ATH_LONG_CALINTERVAL; |
|
cal_interval = min(cal_interval, (u32)ATH_ANI_POLLINTERVAL); |
|
/* |
|
* Short calibration applies only while caldone |
|
* is false or -ETIMEDOUT |
|
*/ |
|
if (common->ani.caldone <= 0) |
|
cal_interval = min(cal_interval, (u32)short_cal_interval); |
|
|
|
ieee80211_queue_delayed_work(common->hw, &priv->ani_work, |
|
msecs_to_jiffies(cal_interval)); |
|
} |
|
|
|
/**********************/ |
|
/* mac80211 Callbacks */ |
|
/**********************/ |
|
|
|
static void ath9k_htc_tx(struct ieee80211_hw *hw, |
|
struct ieee80211_tx_control *control, |
|
struct sk_buff *skb) |
|
{ |
|
struct ieee80211_hdr *hdr; |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
int padpos, padsize, ret, slot; |
|
|
|
hdr = (struct ieee80211_hdr *) skb->data; |
|
|
|
/* Add the padding after the header if this is not already done */ |
|
padpos = ieee80211_hdrlen(hdr->frame_control); |
|
padsize = padpos & 3; |
|
if (padsize && skb->len > padpos) { |
|
if (skb_headroom(skb) < padsize) { |
|
ath_dbg(common, XMIT, "No room for padding\n"); |
|
goto fail_tx; |
|
} |
|
skb_push(skb, padsize); |
|
memmove(skb->data, skb->data + padsize, padpos); |
|
} |
|
|
|
slot = ath9k_htc_tx_get_slot(priv); |
|
if (slot < 0) { |
|
ath_dbg(common, XMIT, "No free TX slot\n"); |
|
goto fail_tx; |
|
} |
|
|
|
ret = ath9k_htc_tx_start(priv, control->sta, skb, slot, false); |
|
if (ret != 0) { |
|
ath_dbg(common, XMIT, "Tx failed\n"); |
|
goto clear_slot; |
|
} |
|
|
|
ath9k_htc_check_stop_queues(priv); |
|
|
|
return; |
|
|
|
clear_slot: |
|
ath9k_htc_tx_clear_slot(priv, slot); |
|
fail_tx: |
|
dev_kfree_skb_any(skb); |
|
} |
|
|
|
static int ath9k_htc_start(struct ieee80211_hw *hw) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_hw *ah = priv->ah; |
|
struct ath_common *common = ath9k_hw_common(ah); |
|
struct ieee80211_channel *curchan = hw->conf.chandef.chan; |
|
struct ath9k_channel *init_channel; |
|
int ret = 0; |
|
enum htc_phymode mode; |
|
__be16 htc_mode; |
|
u8 cmd_rsp; |
|
|
|
mutex_lock(&priv->mutex); |
|
|
|
ath_dbg(common, CONFIG, |
|
"Starting driver with initial channel: %d MHz\n", |
|
curchan->center_freq); |
|
|
|
/* Ensure that HW is awake before flushing RX */ |
|
ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); |
|
WMI_CMD(WMI_FLUSH_RECV_CMDID); |
|
|
|
/* setup initial channel */ |
|
init_channel = ath9k_cmn_get_channel(hw, ah, &hw->conf.chandef); |
|
|
|
ret = ath9k_hw_reset(ah, init_channel, ah->caldata, false); |
|
if (ret) { |
|
ath_err(common, |
|
"Unable to reset hardware; reset status %d (freq %u MHz)\n", |
|
ret, curchan->center_freq); |
|
mutex_unlock(&priv->mutex); |
|
return ret; |
|
} |
|
|
|
ath9k_cmn_update_txpow(ah, priv->curtxpow, priv->txpowlimit, |
|
&priv->curtxpow); |
|
|
|
mode = ath9k_htc_get_curmode(priv, init_channel); |
|
htc_mode = cpu_to_be16(mode); |
|
WMI_CMD_BUF(WMI_SET_MODE_CMDID, &htc_mode); |
|
WMI_CMD(WMI_ATH_INIT_CMDID); |
|
WMI_CMD(WMI_START_RECV_CMDID); |
|
|
|
ath9k_host_rx_init(priv); |
|
|
|
ret = ath9k_htc_update_cap_target(priv, 0); |
|
if (ret) |
|
ath_dbg(common, CONFIG, |
|
"Failed to update capability in target\n"); |
|
|
|
clear_bit(ATH_OP_INVALID, &common->op_flags); |
|
htc_start(priv->htc); |
|
|
|
spin_lock_bh(&priv->tx.tx_lock); |
|
priv->tx.flags &= ~ATH9K_HTC_OP_TX_QUEUES_STOP; |
|
spin_unlock_bh(&priv->tx.tx_lock); |
|
|
|
ieee80211_wake_queues(hw); |
|
|
|
mod_timer(&priv->tx.cleanup_timer, |
|
jiffies + msecs_to_jiffies(ATH9K_HTC_TX_CLEANUP_INTERVAL)); |
|
|
|
ath9k_htc_start_btcoex(priv); |
|
|
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_stop(struct ieee80211_hw *hw) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_hw *ah = priv->ah; |
|
struct ath_common *common = ath9k_hw_common(ah); |
|
int ret __attribute__ ((unused)); |
|
u8 cmd_rsp; |
|
|
|
mutex_lock(&priv->mutex); |
|
|
|
if (test_bit(ATH_OP_INVALID, &common->op_flags)) { |
|
ath_dbg(common, ANY, "Device not present\n"); |
|
mutex_unlock(&priv->mutex); |
|
return; |
|
} |
|
|
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
WMI_CMD(WMI_DISABLE_INTR_CMDID); |
|
WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID); |
|
WMI_CMD(WMI_STOP_RECV_CMDID); |
|
|
|
tasklet_kill(&priv->rx_tasklet); |
|
|
|
del_timer_sync(&priv->tx.cleanup_timer); |
|
ath9k_htc_tx_drain(priv); |
|
ath9k_wmi_event_drain(priv); |
|
|
|
mutex_unlock(&priv->mutex); |
|
|
|
/* Cancel all the running timers/work .. */ |
|
cancel_work_sync(&priv->fatal_work); |
|
cancel_work_sync(&priv->ps_work); |
|
|
|
#ifdef CONFIG_MAC80211_LEDS |
|
cancel_work_sync(&priv->led_work); |
|
#endif |
|
ath9k_htc_stop_ani(priv); |
|
|
|
mutex_lock(&priv->mutex); |
|
|
|
ath9k_htc_stop_btcoex(priv); |
|
|
|
/* Remove a monitor interface if it's present. */ |
|
if (priv->ah->is_monitoring) |
|
ath9k_htc_remove_monitor_interface(priv); |
|
|
|
ath9k_hw_phy_disable(ah); |
|
ath9k_hw_disable(ah); |
|
ath9k_htc_ps_restore(priv); |
|
ath9k_htc_setpower(priv, ATH9K_PM_FULL_SLEEP); |
|
|
|
set_bit(ATH_OP_INVALID, &common->op_flags); |
|
|
|
ath_dbg(common, CONFIG, "Driver halt\n"); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static int ath9k_htc_add_interface(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath9k_htc_vif *avp = (void *)vif->drv_priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_vif hvif; |
|
int ret = 0; |
|
u8 cmd_rsp; |
|
|
|
mutex_lock(&priv->mutex); |
|
|
|
ath9k_htc_ps_wakeup(priv); |
|
memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); |
|
memcpy(&hvif.myaddr, vif->addr, ETH_ALEN); |
|
|
|
switch (vif->type) { |
|
case NL80211_IFTYPE_STATION: |
|
hvif.opmode = HTC_M_STA; |
|
break; |
|
case NL80211_IFTYPE_ADHOC: |
|
hvif.opmode = HTC_M_IBSS; |
|
break; |
|
case NL80211_IFTYPE_AP: |
|
hvif.opmode = HTC_M_HOSTAP; |
|
break; |
|
case NL80211_IFTYPE_MESH_POINT: |
|
hvif.opmode = HTC_M_WDS; /* close enough */ |
|
break; |
|
default: |
|
ath_err(common, |
|
"Interface type %d not yet supported\n", vif->type); |
|
ret = -EOPNOTSUPP; |
|
goto out; |
|
} |
|
|
|
/* Index starts from zero on the target */ |
|
avp->index = hvif.index = ffz(priv->vif_slot); |
|
hvif.rtsthreshold = cpu_to_be16(2304); |
|
WMI_CMD_BUF(WMI_VAP_CREATE_CMDID, &hvif); |
|
if (ret) |
|
goto out; |
|
|
|
/* |
|
* We need a node in target to tx mgmt frames |
|
* before association. |
|
*/ |
|
ret = ath9k_htc_add_station(priv, vif, NULL); |
|
if (ret) { |
|
WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID, &hvif); |
|
goto out; |
|
} |
|
|
|
ath9k_htc_set_mac_bssid_mask(priv, vif); |
|
|
|
priv->vif_slot |= (1 << avp->index); |
|
priv->nvifs++; |
|
|
|
INC_VIF(priv, vif->type); |
|
|
|
if ((vif->type == NL80211_IFTYPE_AP) || |
|
(vif->type == NL80211_IFTYPE_MESH_POINT) || |
|
(vif->type == NL80211_IFTYPE_ADHOC)) |
|
ath9k_htc_assign_bslot(priv, vif); |
|
|
|
ath9k_htc_set_opmode(priv); |
|
|
|
if ((priv->ah->opmode == NL80211_IFTYPE_AP) && |
|
!test_bit(ATH_OP_ANI_RUN, &common->op_flags)) { |
|
ath9k_hw_set_tsfadjust(priv->ah, true); |
|
ath9k_htc_start_ani(priv); |
|
} |
|
|
|
ath_dbg(common, CONFIG, "Attach a VIF of type: %d at idx: %d\n", |
|
vif->type, avp->index); |
|
|
|
out: |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_remove_interface(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_vif *avp = (void *)vif->drv_priv; |
|
struct ath9k_htc_target_vif hvif; |
|
int ret = 0; |
|
u8 cmd_rsp; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); |
|
memcpy(&hvif.myaddr, vif->addr, ETH_ALEN); |
|
hvif.index = avp->index; |
|
WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID, &hvif); |
|
if (ret) { |
|
ath_err(common, "Unable to remove interface at idx: %d\n", |
|
avp->index); |
|
} |
|
priv->nvifs--; |
|
priv->vif_slot &= ~(1 << avp->index); |
|
|
|
if (priv->csa_vif == vif) |
|
priv->csa_vif = NULL; |
|
|
|
ath9k_htc_remove_station(priv, vif, NULL); |
|
|
|
DEC_VIF(priv, vif->type); |
|
|
|
if ((vif->type == NL80211_IFTYPE_AP) || |
|
vif->type == NL80211_IFTYPE_MESH_POINT || |
|
(vif->type == NL80211_IFTYPE_ADHOC)) |
|
ath9k_htc_remove_bslot(priv, vif); |
|
|
|
ath9k_htc_set_opmode(priv); |
|
|
|
ath9k_htc_set_mac_bssid_mask(priv, vif); |
|
|
|
/* |
|
* Stop ANI only if there are no associated station interfaces. |
|
*/ |
|
if ((vif->type == NL80211_IFTYPE_AP) && (priv->num_ap_vif == 0)) { |
|
priv->rearm_ani = false; |
|
ieee80211_iterate_active_interfaces_atomic( |
|
priv->hw, IEEE80211_IFACE_ITER_RESUME_ALL, |
|
ath9k_htc_vif_iter, priv); |
|
if (!priv->rearm_ani) |
|
ath9k_htc_stop_ani(priv); |
|
} |
|
|
|
ath_dbg(common, CONFIG, "Detach Interface at idx: %d\n", avp->index); |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static int ath9k_htc_config(struct ieee80211_hw *hw, u32 changed) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ieee80211_conf *conf = &hw->conf; |
|
bool chip_reset = false; |
|
int ret = 0; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
if (changed & IEEE80211_CONF_CHANGE_IDLE) { |
|
mutex_lock(&priv->htc_pm_lock); |
|
|
|
priv->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE); |
|
if (!priv->ps_idle) |
|
chip_reset = true; |
|
|
|
mutex_unlock(&priv->htc_pm_lock); |
|
} |
|
|
|
/* |
|
* Monitor interface should be added before |
|
* IEEE80211_CONF_CHANGE_CHANNEL is handled. |
|
*/ |
|
if (changed & IEEE80211_CONF_CHANGE_MONITOR) { |
|
if ((conf->flags & IEEE80211_CONF_MONITOR) && |
|
!priv->ah->is_monitoring) |
|
ath9k_htc_add_monitor_interface(priv); |
|
else if (priv->ah->is_monitoring) |
|
ath9k_htc_remove_monitor_interface(priv); |
|
} |
|
|
|
if ((changed & IEEE80211_CONF_CHANGE_CHANNEL) || chip_reset) { |
|
struct ieee80211_channel *curchan = hw->conf.chandef.chan; |
|
int pos = curchan->hw_value; |
|
|
|
ath_dbg(common, CONFIG, "Set channel: %d MHz\n", |
|
curchan->center_freq); |
|
|
|
ath9k_cmn_get_channel(hw, priv->ah, &hw->conf.chandef); |
|
if (ath9k_htc_set_channel(priv, hw, &priv->ah->channels[pos]) < 0) { |
|
ath_err(common, "Unable to set channel\n"); |
|
ret = -EINVAL; |
|
goto out; |
|
} |
|
|
|
} |
|
|
|
if (changed & IEEE80211_CONF_CHANGE_PS) { |
|
if (conf->flags & IEEE80211_CONF_PS) { |
|
ath9k_htc_setpower(priv, ATH9K_PM_NETWORK_SLEEP); |
|
priv->ps_enabled = true; |
|
} else { |
|
priv->ps_enabled = false; |
|
cancel_work_sync(&priv->ps_work); |
|
ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); |
|
} |
|
} |
|
|
|
if (changed & IEEE80211_CONF_CHANGE_POWER) { |
|
priv->txpowlimit = 2 * conf->power_level; |
|
ath9k_cmn_update_txpow(priv->ah, priv->curtxpow, |
|
priv->txpowlimit, &priv->curtxpow); |
|
} |
|
|
|
out: |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
return ret; |
|
} |
|
|
|
#define SUPPORTED_FILTERS \ |
|
(FIF_ALLMULTI | \ |
|
FIF_CONTROL | \ |
|
FIF_PSPOLL | \ |
|
FIF_OTHER_BSS | \ |
|
FIF_BCN_PRBRESP_PROMISC | \ |
|
FIF_PROBE_REQ | \ |
|
FIF_MCAST_ACTION | \ |
|
FIF_FCSFAIL) |
|
|
|
static void ath9k_htc_configure_filter(struct ieee80211_hw *hw, |
|
unsigned int changed_flags, |
|
unsigned int *total_flags, |
|
u64 multicast) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
u32 rfilt; |
|
|
|
mutex_lock(&priv->mutex); |
|
changed_flags &= SUPPORTED_FILTERS; |
|
*total_flags &= SUPPORTED_FILTERS; |
|
|
|
if (test_bit(ATH_OP_INVALID, &common->op_flags)) { |
|
ath_dbg(ath9k_hw_common(priv->ah), ANY, |
|
"Unable to configure filter on invalid state\n"); |
|
mutex_unlock(&priv->mutex); |
|
return; |
|
} |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
priv->rxfilter = *total_flags; |
|
rfilt = ath9k_htc_calcrxfilter(priv); |
|
ath9k_hw_setrxfilter(priv->ah, rfilt); |
|
|
|
ath_dbg(ath9k_hw_common(priv->ah), CONFIG, "Set HW RX filter: 0x%x\n", |
|
rfilt); |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static void ath9k_htc_sta_rc_update_work(struct work_struct *work) |
|
{ |
|
struct ath9k_htc_sta *ista = |
|
container_of(work, struct ath9k_htc_sta, rc_update_work); |
|
struct ieee80211_sta *sta = |
|
container_of((void *)ista, struct ieee80211_sta, drv_priv); |
|
struct ath9k_htc_priv *priv = ista->htc_priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_rate trate; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
memset(&trate, 0, sizeof(struct ath9k_htc_target_rate)); |
|
ath9k_htc_setup_rate(priv, sta, &trate); |
|
if (!ath9k_htc_send_rate_cmd(priv, &trate)) |
|
ath_dbg(common, CONFIG, |
|
"Supported rates for sta: %pM updated, rate caps: 0x%X\n", |
|
sta->addr, be32_to_cpu(trate.capflags)); |
|
else |
|
ath_dbg(common, CONFIG, |
|
"Unable to update supported rates for sta: %pM\n", |
|
sta->addr); |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static int ath9k_htc_sta_add(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath9k_htc_sta *ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
int ret; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
ret = ath9k_htc_add_station(priv, vif, sta); |
|
if (!ret) { |
|
INIT_WORK(&ista->rc_update_work, ath9k_htc_sta_rc_update_work); |
|
ista->htc_priv = priv; |
|
ath9k_htc_init_rate(priv, sta); |
|
} |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static int ath9k_htc_sta_remove(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath9k_htc_sta *ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
int ret; |
|
|
|
cancel_work_sync(&ista->rc_update_work); |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
htc_sta_drain(priv->htc, ista->index); |
|
ret = ath9k_htc_remove_station(priv, vif, sta); |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_sta_rc_update(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta, u32 changed) |
|
{ |
|
struct ath9k_htc_sta *ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
|
|
if (!(changed & IEEE80211_RC_SUPP_RATES_CHANGED)) |
|
return; |
|
|
|
schedule_work(&ista->rc_update_work); |
|
} |
|
|
|
static int ath9k_htc_conf_tx(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, u16 queue, |
|
const struct ieee80211_tx_queue_params *params) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_tx_queue_info qi; |
|
int ret = 0, qnum; |
|
|
|
if (queue >= IEEE80211_NUM_ACS) |
|
return 0; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
memset(&qi, 0, sizeof(struct ath9k_tx_queue_info)); |
|
|
|
qi.tqi_aifs = params->aifs; |
|
qi.tqi_cwmin = params->cw_min; |
|
qi.tqi_cwmax = params->cw_max; |
|
qi.tqi_burstTime = params->txop * 32; |
|
|
|
qnum = get_hw_qnum(queue, priv->hwq_map); |
|
|
|
ath_dbg(common, CONFIG, |
|
"Configure tx [queue/hwq] [%d/%d], aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n", |
|
queue, qnum, params->aifs, params->cw_min, |
|
params->cw_max, params->txop); |
|
|
|
ret = ath_htc_txq_update(priv, qnum, &qi); |
|
if (ret) { |
|
ath_err(common, "TXQ Update failed\n"); |
|
goto out; |
|
} |
|
|
|
if ((priv->ah->opmode == NL80211_IFTYPE_ADHOC) && |
|
(qnum == priv->hwq_map[IEEE80211_AC_BE])) |
|
ath9k_htc_beaconq_config(priv); |
|
out: |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static int ath9k_htc_set_key(struct ieee80211_hw *hw, |
|
enum set_key_cmd cmd, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_sta *sta, |
|
struct ieee80211_key_conf *key) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
int ret = 0; |
|
|
|
if (htc_modparam_nohwcrypt) |
|
return -ENOSPC; |
|
|
|
if ((vif->type == NL80211_IFTYPE_ADHOC || |
|
vif->type == NL80211_IFTYPE_MESH_POINT) && |
|
(key->cipher == WLAN_CIPHER_SUITE_TKIP || |
|
key->cipher == WLAN_CIPHER_SUITE_CCMP) && |
|
!(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) { |
|
/* |
|
* For now, disable hw crypto for the RSN IBSS group keys. This |
|
* could be optimized in the future to use a modified key cache |
|
* design to support per-STA RX GTK, but until that gets |
|
* implemented, use of software crypto for group addressed |
|
* frames is a acceptable to allow RSN IBSS to be used. |
|
*/ |
|
return -EOPNOTSUPP; |
|
} |
|
|
|
mutex_lock(&priv->mutex); |
|
ath_dbg(common, CONFIG, "Set HW Key\n"); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
switch (cmd) { |
|
case SET_KEY: |
|
ret = ath_key_config(common, vif, sta, key); |
|
if (ret >= 0) { |
|
key->hw_key_idx = ret; |
|
/* push IV and Michael MIC generation to stack */ |
|
key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; |
|
if (key->cipher == WLAN_CIPHER_SUITE_TKIP) |
|
key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; |
|
if (priv->ah->sw_mgmt_crypto_tx && |
|
key->cipher == WLAN_CIPHER_SUITE_CCMP) |
|
key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; |
|
ret = 0; |
|
} |
|
break; |
|
case DISABLE_KEY: |
|
ath_key_delete(common, key->hw_key_idx); |
|
break; |
|
default: |
|
ret = -EINVAL; |
|
} |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_set_bssid(struct ath9k_htc_priv *priv) |
|
{ |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
|
|
ath9k_hw_write_associd(priv->ah); |
|
ath_dbg(common, CONFIG, "BSSID: %pM aid: 0x%x\n", |
|
common->curbssid, common->curaid); |
|
} |
|
|
|
static void ath9k_htc_bss_iter(void *data, u8 *mac, struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = data; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; |
|
|
|
if ((vif->type == NL80211_IFTYPE_STATION) && bss_conf->assoc) { |
|
common->curaid = bss_conf->aid; |
|
common->last_rssi = ATH_RSSI_DUMMY_MARKER; |
|
memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN); |
|
set_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags); |
|
} |
|
} |
|
|
|
static void ath9k_htc_choose_set_bssid(struct ath9k_htc_priv *priv) |
|
{ |
|
if (priv->num_sta_assoc_vif == 1) { |
|
ieee80211_iterate_active_interfaces_atomic( |
|
priv->hw, IEEE80211_IFACE_ITER_RESUME_ALL, |
|
ath9k_htc_bss_iter, priv); |
|
ath9k_htc_set_bssid(priv); |
|
} |
|
} |
|
|
|
static void ath9k_htc_bss_info_changed(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_bss_conf *bss_conf, |
|
u32 changed) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_hw *ah = priv->ah; |
|
struct ath_common *common = ath9k_hw_common(ah); |
|
int slottime; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
if (changed & BSS_CHANGED_ASSOC) { |
|
ath_dbg(common, CONFIG, "BSS Changed ASSOC %d\n", |
|
bss_conf->assoc); |
|
|
|
bss_conf->assoc ? |
|
priv->num_sta_assoc_vif++ : priv->num_sta_assoc_vif--; |
|
|
|
if (!bss_conf->assoc) |
|
clear_bit(ATH_OP_PRIM_STA_VIF, &common->op_flags); |
|
|
|
if (priv->ah->opmode == NL80211_IFTYPE_STATION) { |
|
ath9k_htc_choose_set_bssid(priv); |
|
if (bss_conf->assoc && (priv->num_sta_assoc_vif == 1)) |
|
ath9k_htc_start_ani(priv); |
|
else if (priv->num_sta_assoc_vif == 0) |
|
ath9k_htc_stop_ani(priv); |
|
} |
|
} |
|
|
|
if (changed & BSS_CHANGED_IBSS) { |
|
if (priv->ah->opmode == NL80211_IFTYPE_ADHOC) { |
|
common->curaid = bss_conf->aid; |
|
memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN); |
|
ath9k_htc_set_bssid(priv); |
|
} |
|
} |
|
|
|
if ((changed & BSS_CHANGED_BEACON_ENABLED) && bss_conf->enable_beacon) { |
|
ath_dbg(common, CONFIG, "Beacon enabled for BSS: %pM\n", |
|
bss_conf->bssid); |
|
ath9k_htc_set_tsfadjust(priv, vif); |
|
priv->cur_beacon_conf.enable_beacon = 1; |
|
ath9k_htc_beacon_config(priv, vif); |
|
} |
|
|
|
if ((changed & BSS_CHANGED_BEACON_ENABLED) && !bss_conf->enable_beacon) { |
|
/* |
|
* Disable SWBA interrupt only if there are no |
|
* concurrent AP/mesh or IBSS interfaces. |
|
*/ |
|
if ((priv->num_ap_vif + priv->num_mbss_vif <= 1) || |
|
priv->num_ibss_vif) { |
|
ath_dbg(common, CONFIG, |
|
"Beacon disabled for BSS: %pM\n", |
|
bss_conf->bssid); |
|
priv->cur_beacon_conf.enable_beacon = 0; |
|
ath9k_htc_beacon_config(priv, vif); |
|
} |
|
} |
|
|
|
if (changed & BSS_CHANGED_BEACON_INT) { |
|
/* |
|
* Reset the HW TSF for the first AP or mesh interface. |
|
*/ |
|
if (priv->nvifs == 1 && |
|
((priv->ah->opmode == NL80211_IFTYPE_AP && |
|
vif->type == NL80211_IFTYPE_AP && |
|
priv->num_ap_vif == 1) || |
|
(priv->ah->opmode == NL80211_IFTYPE_MESH_POINT && |
|
vif->type == NL80211_IFTYPE_MESH_POINT && |
|
priv->num_mbss_vif == 1))) { |
|
set_bit(OP_TSF_RESET, &priv->op_flags); |
|
} |
|
ath_dbg(common, CONFIG, |
|
"Beacon interval changed for BSS: %pM\n", |
|
bss_conf->bssid); |
|
ath9k_htc_beacon_config(priv, vif); |
|
} |
|
|
|
if (changed & BSS_CHANGED_ERP_SLOT) { |
|
if (bss_conf->use_short_slot) |
|
slottime = 9; |
|
else |
|
slottime = 20; |
|
if (vif->type == NL80211_IFTYPE_AP) { |
|
/* |
|
* Defer update, so that connected stations can adjust |
|
* their settings at the same time. |
|
* See beacon.c for more details |
|
*/ |
|
priv->beacon.slottime = slottime; |
|
priv->beacon.updateslot = UPDATE; |
|
} else { |
|
ah->slottime = slottime; |
|
ath9k_hw_init_global_settings(ah); |
|
} |
|
} |
|
|
|
if (changed & BSS_CHANGED_HT) |
|
ath9k_htc_update_rate(priv, vif, bss_conf); |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static u64 ath9k_htc_get_tsf(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
u64 tsf; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
tsf = ath9k_hw_gettsf64(priv->ah); |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return tsf; |
|
} |
|
|
|
static void ath9k_htc_set_tsf(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, u64 tsf) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
ath9k_hw_settsf64(priv->ah, tsf); |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static void ath9k_htc_reset_tsf(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
ath9k_hw_reset_tsf(priv->ah); |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static int ath9k_htc_ampdu_action(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
struct ieee80211_ampdu_params *params) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath9k_htc_sta *ista; |
|
int ret = 0; |
|
struct ieee80211_sta *sta = params->sta; |
|
enum ieee80211_ampdu_mlme_action action = params->action; |
|
u16 tid = params->tid; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
|
|
switch (action) { |
|
case IEEE80211_AMPDU_RX_START: |
|
break; |
|
case IEEE80211_AMPDU_RX_STOP: |
|
break; |
|
case IEEE80211_AMPDU_TX_START: |
|
ret = ath9k_htc_tx_aggr_oper(priv, vif, sta, action, tid); |
|
if (!ret) |
|
ret = IEEE80211_AMPDU_TX_START_IMMEDIATE; |
|
break; |
|
case IEEE80211_AMPDU_TX_STOP_CONT: |
|
case IEEE80211_AMPDU_TX_STOP_FLUSH: |
|
case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: |
|
ath9k_htc_tx_aggr_oper(priv, vif, sta, action, tid); |
|
ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); |
|
break; |
|
case IEEE80211_AMPDU_TX_OPERATIONAL: |
|
if (tid >= ATH9K_HTC_MAX_TID) { |
|
ret = -EINVAL; |
|
break; |
|
} |
|
ista = (struct ath9k_htc_sta *) sta->drv_priv; |
|
spin_lock_bh(&priv->tx.tx_lock); |
|
ista->tid_state[tid] = AGGR_OPERATIONAL; |
|
spin_unlock_bh(&priv->tx.tx_lock); |
|
break; |
|
default: |
|
ath_err(ath9k_hw_common(priv->ah), "Unknown AMPDU action\n"); |
|
} |
|
|
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
|
|
return ret; |
|
} |
|
|
|
static void ath9k_htc_sw_scan_start(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
const u8 *mac_addr) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
|
|
mutex_lock(&priv->mutex); |
|
spin_lock_bh(&priv->beacon_lock); |
|
set_bit(ATH_OP_SCANNING, &common->op_flags); |
|
spin_unlock_bh(&priv->beacon_lock); |
|
cancel_work_sync(&priv->ps_work); |
|
ath9k_htc_stop_ani(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static void ath9k_htc_sw_scan_complete(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
|
|
mutex_lock(&priv->mutex); |
|
spin_lock_bh(&priv->beacon_lock); |
|
clear_bit(ATH_OP_SCANNING, &common->op_flags); |
|
spin_unlock_bh(&priv->beacon_lock); |
|
ath9k_htc_ps_wakeup(priv); |
|
ath9k_htc_vif_reconfig(priv); |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
static int ath9k_htc_set_rts_threshold(struct ieee80211_hw *hw, u32 value) |
|
{ |
|
return 0; |
|
} |
|
|
|
static void ath9k_htc_set_coverage_class(struct ieee80211_hw *hw, |
|
s16 coverage_class) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
|
|
mutex_lock(&priv->mutex); |
|
ath9k_htc_ps_wakeup(priv); |
|
priv->ah->coverage_class = coverage_class; |
|
ath9k_hw_init_global_settings(priv->ah); |
|
ath9k_htc_ps_restore(priv); |
|
mutex_unlock(&priv->mutex); |
|
} |
|
|
|
/* |
|
* Currently, this is used only for selecting the minimum rate |
|
* for management frames, rate selection for data frames remain |
|
* unaffected. |
|
*/ |
|
static int ath9k_htc_set_bitrate_mask(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
const struct cfg80211_bitrate_mask *mask) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_common *common = ath9k_hw_common(priv->ah); |
|
struct ath9k_htc_target_rate_mask tmask; |
|
struct ath9k_htc_vif *avp = (void *)vif->drv_priv; |
|
int ret = 0; |
|
u8 cmd_rsp; |
|
|
|
memset(&tmask, 0, sizeof(struct ath9k_htc_target_rate_mask)); |
|
|
|
tmask.vif_index = avp->index; |
|
tmask.band = NL80211_BAND_2GHZ; |
|
tmask.mask = cpu_to_be32(mask->control[NL80211_BAND_2GHZ].legacy); |
|
|
|
WMI_CMD_BUF(WMI_BITRATE_MASK_CMDID, &tmask); |
|
if (ret) { |
|
ath_err(common, |
|
"Unable to set 2G rate mask for " |
|
"interface at idx: %d\n", avp->index); |
|
goto out; |
|
} |
|
|
|
tmask.band = NL80211_BAND_5GHZ; |
|
tmask.mask = cpu_to_be32(mask->control[NL80211_BAND_5GHZ].legacy); |
|
|
|
WMI_CMD_BUF(WMI_BITRATE_MASK_CMDID, &tmask); |
|
if (ret) { |
|
ath_err(common, |
|
"Unable to set 5G rate mask for " |
|
"interface at idx: %d\n", avp->index); |
|
goto out; |
|
} |
|
|
|
ath_dbg(common, CONFIG, "Set bitrate masks: 0x%x, 0x%x\n", |
|
mask->control[NL80211_BAND_2GHZ].legacy, |
|
mask->control[NL80211_BAND_5GHZ].legacy); |
|
out: |
|
return ret; |
|
} |
|
|
|
|
|
static int ath9k_htc_get_stats(struct ieee80211_hw *hw, |
|
struct ieee80211_low_level_stats *stats) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct ath_hw *ah = priv->ah; |
|
struct ath9k_mib_stats *mib_stats = &ah->ah_mibStats; |
|
|
|
stats->dot11ACKFailureCount = mib_stats->ackrcv_bad; |
|
stats->dot11RTSFailureCount = mib_stats->rts_bad; |
|
stats->dot11FCSErrorCount = mib_stats->fcs_bad; |
|
stats->dot11RTSSuccessCount = mib_stats->rts_good; |
|
|
|
return 0; |
|
} |
|
|
|
struct base_eep_header *ath9k_htc_get_eeprom_base(struct ath9k_htc_priv *priv) |
|
{ |
|
struct base_eep_header *pBase = NULL; |
|
/* |
|
* This can be done since all the 3 EEPROM families have the |
|
* same base header upto a certain point, and we are interested in |
|
* the data only upto that point. |
|
*/ |
|
|
|
if (AR_SREV_9271(priv->ah)) |
|
pBase = (struct base_eep_header *) |
|
&priv->ah->eeprom.map4k.baseEepHeader; |
|
else if (priv->ah->hw_version.usbdev == AR9280_USB) |
|
pBase = (struct base_eep_header *) |
|
&priv->ah->eeprom.def.baseEepHeader; |
|
else if (priv->ah->hw_version.usbdev == AR9287_USB) |
|
pBase = (struct base_eep_header *) |
|
&priv->ah->eeprom.map9287.baseEepHeader; |
|
return pBase; |
|
} |
|
|
|
|
|
static int ath9k_htc_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, |
|
u32 *rx_ant) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
struct base_eep_header *pBase = ath9k_htc_get_eeprom_base(priv); |
|
if (pBase) { |
|
*tx_ant = pBase->txMask; |
|
*rx_ant = pBase->rxMask; |
|
} else { |
|
*tx_ant = 0; |
|
*rx_ant = 0; |
|
} |
|
return 0; |
|
} |
|
|
|
static void ath9k_htc_channel_switch_beacon(struct ieee80211_hw *hw, |
|
struct ieee80211_vif *vif, |
|
struct cfg80211_chan_def *chandef) |
|
{ |
|
struct ath9k_htc_priv *priv = hw->priv; |
|
|
|
/* mac80211 does not support CSA in multi-if cases (yet) */ |
|
if (WARN_ON(priv->csa_vif)) |
|
return; |
|
|
|
priv->csa_vif = vif; |
|
} |
|
|
|
struct ieee80211_ops ath9k_htc_ops = { |
|
.tx = ath9k_htc_tx, |
|
.start = ath9k_htc_start, |
|
.stop = ath9k_htc_stop, |
|
.add_interface = ath9k_htc_add_interface, |
|
.remove_interface = ath9k_htc_remove_interface, |
|
.config = ath9k_htc_config, |
|
.configure_filter = ath9k_htc_configure_filter, |
|
.sta_add = ath9k_htc_sta_add, |
|
.sta_remove = ath9k_htc_sta_remove, |
|
.conf_tx = ath9k_htc_conf_tx, |
|
.sta_rc_update = ath9k_htc_sta_rc_update, |
|
.bss_info_changed = ath9k_htc_bss_info_changed, |
|
.set_key = ath9k_htc_set_key, |
|
.get_tsf = ath9k_htc_get_tsf, |
|
.set_tsf = ath9k_htc_set_tsf, |
|
.reset_tsf = ath9k_htc_reset_tsf, |
|
.ampdu_action = ath9k_htc_ampdu_action, |
|
.sw_scan_start = ath9k_htc_sw_scan_start, |
|
.sw_scan_complete = ath9k_htc_sw_scan_complete, |
|
.set_rts_threshold = ath9k_htc_set_rts_threshold, |
|
.rfkill_poll = ath9k_htc_rfkill_poll_state, |
|
.set_coverage_class = ath9k_htc_set_coverage_class, |
|
.set_bitrate_mask = ath9k_htc_set_bitrate_mask, |
|
.get_stats = ath9k_htc_get_stats, |
|
.get_antenna = ath9k_htc_get_antenna, |
|
.channel_switch_beacon = ath9k_htc_channel_switch_beacon, |
|
|
|
#ifdef CONFIG_ATH9K_HTC_DEBUGFS |
|
.get_et_sset_count = ath9k_htc_get_et_sset_count, |
|
.get_et_stats = ath9k_htc_get_et_stats, |
|
.get_et_strings = ath9k_htc_get_et_strings, |
|
#endif |
|
};
|
|
|