| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| #include "htc.h" |
| |
| |
| |
| |
| |
| |
| 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); |
| |
| <------> |
| <------> 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); |
| |
| <------> |
| <------>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)); |
| |
| <------> |
| <------>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; |
| } |
| |
| |
| |
| |
| |
| |
| |
| |
| 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; |
| } |
| |
| |
| |
| |
| |
| 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; |
| |
| <------> |
| <------>if (ah->power_mode != ATH9K_PM_AWAKE) |
| <------><------>goto set_timer; |
| |
| <------> |
| <------>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; |
| <------><------>} |
| <------>} |
| |
| <------> |
| <------>if ((timestamp - common->ani.checkani_timer) >= ATH_ANI_POLLINTERVAL) { |
| <------><------>aniflag = true; |
| <------><------>common->ani.checkani_timer = timestamp; |
| <------>} |
| |
| <------> |
| <------>if (longcal || shortcal || aniflag) { |
| |
| <------><------>ath9k_htc_ps_wakeup(priv); |
| |
| <------><------> |
| <------><------>if (aniflag) |
| <------><------><------>ath9k_hw_ani_monitor(ah, ah->curchan); |
| |
| <------><------> |
| <------><------>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)); |
| } |
| |
| |
| |
| |
| |
| 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; |
| |
| <------> |
| <------>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); |
| |
| <------> |
| <------>ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); |
| <------>WMI_CMD(WMI_FLUSH_RECV_CMDID); |
| |
| <------> |
| <------>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_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); |
| |
| <------> |
| <------>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; |
| <------><------>break; |
| <------>default: |
| <------><------>ath_err(common, |
| <------><------><------>"Interface type %d not yet supported\n", vif->type); |
| <------><------>ret = -EOPNOTSUPP; |
| <------><------>goto out; |
| <------>} |
| |
| <------> |
| <------>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; |
| <------><------><------> |
| <------><------><------>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); |
| } |
| |
| |
| |
| |
| |
| |
| 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; |
| |
| <------> |
| <------>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 |
| }; |
| |