1e705c121SKalle Valo /****************************************************************************** 2e705c121SKalle Valo * 3e705c121SKalle Valo * This file is provided under a dual BSD/GPLv2 license. When using or 4e705c121SKalle Valo * redistributing this file, you may do so under either license. 5e705c121SKalle Valo * 6e705c121SKalle Valo * GPL LICENSE SUMMARY 7e705c121SKalle Valo * 8e705c121SKalle Valo * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 9e705c121SKalle Valo * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH 10cfbeb598SGoodstein, Mordechay * Copyright(c) 2016 - 2017 Intel Deutschland GmbH 11e705c121SKalle Valo * 12e705c121SKalle Valo * This program is free software; you can redistribute it and/or modify 13e705c121SKalle Valo * it under the terms of version 2 of the GNU General Public License as 14e705c121SKalle Valo * published by the Free Software Foundation. 15e705c121SKalle Valo * 16e705c121SKalle Valo * This program is distributed in the hope that it will be useful, but 17e705c121SKalle Valo * WITHOUT ANY WARRANTY; without even the implied warranty of 18e705c121SKalle Valo * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 19e705c121SKalle Valo * General Public License for more details. 20e705c121SKalle Valo * 21e705c121SKalle Valo * The full GNU General Public License is included in this distribution 22e705c121SKalle Valo * in the file called COPYING. 23e705c121SKalle Valo * 24e705c121SKalle Valo * Contact Information: 25cb2f8277SEmmanuel Grumbach * Intel Linux Wireless <linuxwifi@intel.com> 26e705c121SKalle Valo * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 27e705c121SKalle Valo * 28e705c121SKalle Valo * BSD LICENSE 29e705c121SKalle Valo * 30e705c121SKalle Valo * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 31e705c121SKalle Valo * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH 32e705c121SKalle Valo * All rights reserved. 33e705c121SKalle Valo * 34e705c121SKalle Valo * Redistribution and use in source and binary forms, with or without 35e705c121SKalle Valo * modification, are permitted provided that the following conditions 36e705c121SKalle Valo * are met: 37e705c121SKalle Valo * 38e705c121SKalle Valo * * Redistributions of source code must retain the above copyright 39e705c121SKalle Valo * notice, this list of conditions and the following disclaimer. 40e705c121SKalle Valo * * Redistributions in binary form must reproduce the above copyright 41e705c121SKalle Valo * notice, this list of conditions and the following disclaimer in 42e705c121SKalle Valo * the documentation and/or other materials provided with the 43e705c121SKalle Valo * distribution. 44e705c121SKalle Valo * * Neither the name Intel Corporation nor the names of its 45e705c121SKalle Valo * contributors may be used to endorse or promote products derived 46e705c121SKalle Valo * from this software without specific prior written permission. 47e705c121SKalle Valo * 48e705c121SKalle Valo * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 49e705c121SKalle Valo * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 50e705c121SKalle Valo * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 51e705c121SKalle Valo * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 52e705c121SKalle Valo * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 53e705c121SKalle Valo * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 54e705c121SKalle Valo * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 55e705c121SKalle Valo * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 56e705c121SKalle Valo * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 57e705c121SKalle Valo * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 58e705c121SKalle Valo * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 59e705c121SKalle Valo *****************************************************************************/ 60a399f980SJohannes Berg #include <linux/etherdevice.h> 61e705c121SKalle Valo #include <linux/skbuff.h> 62e705c121SKalle Valo #include "iwl-trans.h" 63e705c121SKalle Valo #include "mvm.h" 64e705c121SKalle Valo #include "fw-api.h" 65e705c121SKalle Valo 66e705c121SKalle Valo /* 67e705c121SKalle Valo * iwl_mvm_rx_rx_phy_cmd - REPLY_RX_PHY_CMD handler 68e705c121SKalle Valo * 69e705c121SKalle Valo * Copies the phy information in mvm->last_phy_info, it will be used when the 70e705c121SKalle Valo * actual data will come from the fw in the next packet. 71e705c121SKalle Valo */ 72e705c121SKalle Valo void iwl_mvm_rx_rx_phy_cmd(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb) 73e705c121SKalle Valo { 74e705c121SKalle Valo struct iwl_rx_packet *pkt = rxb_addr(rxb); 75e705c121SKalle Valo 76e705c121SKalle Valo memcpy(&mvm->last_phy_info, pkt->data, sizeof(mvm->last_phy_info)); 77e705c121SKalle Valo mvm->ampdu_ref++; 78e705c121SKalle Valo 79e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS 80e705c121SKalle Valo if (mvm->last_phy_info.phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_AGG)) { 81e705c121SKalle Valo spin_lock(&mvm->drv_stats_lock); 82e705c121SKalle Valo mvm->drv_rx_stats.ampdu_count++; 83e705c121SKalle Valo spin_unlock(&mvm->drv_stats_lock); 84e705c121SKalle Valo } 85e705c121SKalle Valo #endif 86e705c121SKalle Valo } 87e705c121SKalle Valo 88e705c121SKalle Valo /* 89e705c121SKalle Valo * iwl_mvm_pass_packet_to_mac80211 - builds the packet for mac80211 90e705c121SKalle Valo * 91e705c121SKalle Valo * Adds the rxb to a new skb and give it to mac80211 92e705c121SKalle Valo */ 93e705c121SKalle Valo static void iwl_mvm_pass_packet_to_mac80211(struct iwl_mvm *mvm, 9443ec72b7SJohannes Berg struct ieee80211_sta *sta, 95e705c121SKalle Valo struct napi_struct *napi, 96e705c121SKalle Valo struct sk_buff *skb, 97e705c121SKalle Valo struct ieee80211_hdr *hdr, u16 len, 98bdbc58abSDan Carpenter u8 crypt_len, 99e705c121SKalle Valo struct iwl_rx_cmd_buffer *rxb) 100e705c121SKalle Valo { 1015cddd05cSJohannes Berg unsigned int hdrlen = ieee80211_hdrlen(hdr->frame_control); 1025cddd05cSJohannes Berg unsigned int fraglen; 1035cddd05cSJohannes Berg 1045cddd05cSJohannes Berg /* 1055cddd05cSJohannes Berg * The 'hdrlen' (plus the 8 bytes for the SNAP and the crypt_len, 1065cddd05cSJohannes Berg * but those are all multiples of 4 long) all goes away, but we 1075cddd05cSJohannes Berg * want the *end* of it, which is going to be the start of the IP 1085cddd05cSJohannes Berg * header, to be aligned when it gets pulled in. 1095cddd05cSJohannes Berg * The beginning of the skb->data is aligned on at least a 4-byte 1105cddd05cSJohannes Berg * boundary after allocation. Everything here is aligned at least 1115cddd05cSJohannes Berg * on a 2-byte boundary so we can just take hdrlen & 3 and pad by 1125cddd05cSJohannes Berg * the result. 1135cddd05cSJohannes Berg */ 1145cddd05cSJohannes Berg skb_reserve(skb, hdrlen & 3); 115e705c121SKalle Valo 116e705c121SKalle Valo /* If frame is small enough to fit in skb->head, pull it completely. 117e705c121SKalle Valo * If not, only pull ieee80211_hdr (including crypto if present, and 118e705c121SKalle Valo * an additional 8 bytes for SNAP/ethertype, see below) so that 119e705c121SKalle Valo * splice() or TCP coalesce are more efficient. 120e705c121SKalle Valo * 121e705c121SKalle Valo * Since, in addition, ieee80211_data_to_8023() always pull in at 122e705c121SKalle Valo * least 8 bytes (possibly more for mesh) we can do the same here 123e705c121SKalle Valo * to save the cost of doing it later. That still doesn't pull in 124e705c121SKalle Valo * the actual IP header since the typical case has a SNAP header. 125e705c121SKalle Valo * If the latter changes (there are efforts in the standards group 126e705c121SKalle Valo * to do so) we should revisit this and ieee80211_data_to_8023(). 127e705c121SKalle Valo */ 1285cddd05cSJohannes Berg hdrlen = (len <= skb_tailroom(skb)) ? len : hdrlen + crypt_len + 8; 129e705c121SKalle Valo 13059ae1d12SJohannes Berg skb_put_data(skb, hdr, hdrlen); 131e705c121SKalle Valo fraglen = len - hdrlen; 132e705c121SKalle Valo 133e705c121SKalle Valo if (fraglen) { 134e705c121SKalle Valo int offset = (void *)hdr + hdrlen - 135e705c121SKalle Valo rxb_addr(rxb) + rxb_offset(rxb); 136e705c121SKalle Valo 137e705c121SKalle Valo skb_add_rx_frag(skb, 0, rxb_steal_page(rxb), offset, 138e705c121SKalle Valo fraglen, rxb->truesize); 139e705c121SKalle Valo } 140e705c121SKalle Valo 14143ec72b7SJohannes Berg ieee80211_rx_napi(mvm->hw, sta, skb, napi); 142e705c121SKalle Valo } 143e705c121SKalle Valo 144e705c121SKalle Valo /* 145e705c121SKalle Valo * iwl_mvm_get_signal_strength - use new rx PHY INFO API 146e705c121SKalle Valo * values are reported by the fw as positive values - need to negate 147e705c121SKalle Valo * to obtain their dBM. Account for missing antennas by replacing 0 148e705c121SKalle Valo * values by -256dBm: practically 0 power and a non-feasible 8 bit value. 149e705c121SKalle Valo */ 150e705c121SKalle Valo static void iwl_mvm_get_signal_strength(struct iwl_mvm *mvm, 151e705c121SKalle Valo struct iwl_rx_phy_info *phy_info, 152e705c121SKalle Valo struct ieee80211_rx_status *rx_status) 153e705c121SKalle Valo { 154e705c121SKalle Valo int energy_a, energy_b, energy_c, max_energy; 155e705c121SKalle Valo u32 val; 156e705c121SKalle Valo 157e705c121SKalle Valo val = 158e705c121SKalle Valo le32_to_cpu(phy_info->non_cfg_phy[IWL_RX_INFO_ENERGY_ANT_ABC_IDX]); 159e705c121SKalle Valo energy_a = (val & IWL_RX_INFO_ENERGY_ANT_A_MSK) >> 160e705c121SKalle Valo IWL_RX_INFO_ENERGY_ANT_A_POS; 161e705c121SKalle Valo energy_a = energy_a ? -energy_a : S8_MIN; 162e705c121SKalle Valo energy_b = (val & IWL_RX_INFO_ENERGY_ANT_B_MSK) >> 163e705c121SKalle Valo IWL_RX_INFO_ENERGY_ANT_B_POS; 164e705c121SKalle Valo energy_b = energy_b ? -energy_b : S8_MIN; 165e705c121SKalle Valo energy_c = (val & IWL_RX_INFO_ENERGY_ANT_C_MSK) >> 166e705c121SKalle Valo IWL_RX_INFO_ENERGY_ANT_C_POS; 167e705c121SKalle Valo energy_c = energy_c ? -energy_c : S8_MIN; 168e705c121SKalle Valo max_energy = max(energy_a, energy_b); 169e705c121SKalle Valo max_energy = max(max_energy, energy_c); 170e705c121SKalle Valo 171e705c121SKalle Valo IWL_DEBUG_STATS(mvm, "energy In A %d B %d C %d , and max %d\n", 172e705c121SKalle Valo energy_a, energy_b, energy_c, max_energy); 173e705c121SKalle Valo 174e705c121SKalle Valo rx_status->signal = max_energy; 175e705c121SKalle Valo rx_status->chains = (le16_to_cpu(phy_info->phy_flags) & 176e705c121SKalle Valo RX_RES_PHY_FLAGS_ANTENNA) 177e705c121SKalle Valo >> RX_RES_PHY_FLAGS_ANTENNA_POS; 178e705c121SKalle Valo rx_status->chain_signal[0] = energy_a; 179e705c121SKalle Valo rx_status->chain_signal[1] = energy_b; 180e705c121SKalle Valo rx_status->chain_signal[2] = energy_c; 181e705c121SKalle Valo } 182e705c121SKalle Valo 183e705c121SKalle Valo /* 184e705c121SKalle Valo * iwl_mvm_set_mac80211_rx_flag - translate fw status to mac80211 format 185e705c121SKalle Valo * @mvm: the mvm object 186e705c121SKalle Valo * @hdr: 80211 header 187e705c121SKalle Valo * @stats: status in mac80211's format 188e705c121SKalle Valo * @rx_pkt_status: status coming from fw 189e705c121SKalle Valo * 190e705c121SKalle Valo * returns non 0 value if the packet should be dropped 191e705c121SKalle Valo */ 192e705c121SKalle Valo static u32 iwl_mvm_set_mac80211_rx_flag(struct iwl_mvm *mvm, 193e705c121SKalle Valo struct ieee80211_hdr *hdr, 194e705c121SKalle Valo struct ieee80211_rx_status *stats, 195e705c121SKalle Valo u32 rx_pkt_status, 196e705c121SKalle Valo u8 *crypt_len) 197e705c121SKalle Valo { 198e705c121SKalle Valo if (!ieee80211_has_protected(hdr->frame_control) || 199e705c121SKalle Valo (rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) == 200e705c121SKalle Valo RX_MPDU_RES_STATUS_SEC_NO_ENC) 201e705c121SKalle Valo return 0; 202e705c121SKalle Valo 203e705c121SKalle Valo /* packet was encrypted with unknown alg */ 204e705c121SKalle Valo if ((rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) == 205e705c121SKalle Valo RX_MPDU_RES_STATUS_SEC_ENC_ERR) 206e705c121SKalle Valo return 0; 207e705c121SKalle Valo 208e705c121SKalle Valo switch (rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) { 209e705c121SKalle Valo case RX_MPDU_RES_STATUS_SEC_CCM_ENC: 210e705c121SKalle Valo /* alg is CCM: check MIC only */ 211e705c121SKalle Valo if (!(rx_pkt_status & RX_MPDU_RES_STATUS_MIC_OK)) 212e705c121SKalle Valo return -1; 213e705c121SKalle Valo 214e705c121SKalle Valo stats->flag |= RX_FLAG_DECRYPTED; 215e705c121SKalle Valo *crypt_len = IEEE80211_CCMP_HDR_LEN; 216e705c121SKalle Valo return 0; 217e705c121SKalle Valo 218e705c121SKalle Valo case RX_MPDU_RES_STATUS_SEC_TKIP_ENC: 219e705c121SKalle Valo /* Don't drop the frame and decrypt it in SW */ 22057df3839SSara Sharon if (!fw_has_api(&mvm->fw->ucode_capa, 22157df3839SSara Sharon IWL_UCODE_TLV_API_DEPRECATE_TTAK) && 22257df3839SSara Sharon !(rx_pkt_status & RX_MPDU_RES_STATUS_TTAK_OK)) 223e705c121SKalle Valo return 0; 224e705c121SKalle Valo *crypt_len = IEEE80211_TKIP_IV_LEN; 225e705c121SKalle Valo /* fall through if TTAK OK */ 226e705c121SKalle Valo 227e705c121SKalle Valo case RX_MPDU_RES_STATUS_SEC_WEP_ENC: 228e705c121SKalle Valo if (!(rx_pkt_status & RX_MPDU_RES_STATUS_ICV_OK)) 229e705c121SKalle Valo return -1; 230e705c121SKalle Valo 231e705c121SKalle Valo stats->flag |= RX_FLAG_DECRYPTED; 232e705c121SKalle Valo if ((rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) == 233e705c121SKalle Valo RX_MPDU_RES_STATUS_SEC_WEP_ENC) 234e705c121SKalle Valo *crypt_len = IEEE80211_WEP_IV_LEN; 235e705c121SKalle Valo return 0; 236e705c121SKalle Valo 237e705c121SKalle Valo case RX_MPDU_RES_STATUS_SEC_EXT_ENC: 238e705c121SKalle Valo if (!(rx_pkt_status & RX_MPDU_RES_STATUS_MIC_OK)) 239e705c121SKalle Valo return -1; 240e705c121SKalle Valo stats->flag |= RX_FLAG_DECRYPTED; 241e705c121SKalle Valo return 0; 242e705c121SKalle Valo 243e705c121SKalle Valo default: 244baf41bc3SShaul Triebitz /* Expected in monitor (not having the keys) */ 245baf41bc3SShaul Triebitz if (!mvm->monitor_on) 246e705c121SKalle Valo IWL_ERR(mvm, "Unhandled alg: 0x%x\n", rx_pkt_status); 247e705c121SKalle Valo } 248e705c121SKalle Valo 249e705c121SKalle Valo return 0; 250e705c121SKalle Valo } 251e705c121SKalle Valo 2527d9d0d56SLuca Coelho static void iwl_mvm_rx_handle_tcm(struct iwl_mvm *mvm, 2537d9d0d56SLuca Coelho struct ieee80211_sta *sta, 2547d9d0d56SLuca Coelho struct ieee80211_hdr *hdr, u32 len, 2557d9d0d56SLuca Coelho struct iwl_rx_phy_info *phy_info, 2567d9d0d56SLuca Coelho u32 rate_n_flags) 2577d9d0d56SLuca Coelho { 2587d9d0d56SLuca Coelho struct iwl_mvm_sta *mvmsta; 2597d9d0d56SLuca Coelho struct iwl_mvm_tcm_mac *mdata; 2607d9d0d56SLuca Coelho int mac; 2617d9d0d56SLuca Coelho int ac = IEEE80211_AC_BE; /* treat non-QoS as BE */ 262b0ffe455SJohannes Berg struct iwl_mvm_vif *mvmvif; 263b0ffe455SJohannes Berg /* expected throughput in 100Kbps, single stream, 20 MHz */ 264b0ffe455SJohannes Berg static const u8 thresh_tpt[] = { 265b0ffe455SJohannes Berg 9, 18, 30, 42, 60, 78, 90, 96, 120, 135, 266b0ffe455SJohannes Berg }; 267b0ffe455SJohannes Berg u16 thr; 2687d9d0d56SLuca Coelho 2697d9d0d56SLuca Coelho if (ieee80211_is_data_qos(hdr->frame_control)) 2707d9d0d56SLuca Coelho ac = tid_to_mac80211_ac[ieee80211_get_tid(hdr)]; 2717d9d0d56SLuca Coelho 2727d9d0d56SLuca Coelho mvmsta = iwl_mvm_sta_from_mac80211(sta); 2737d9d0d56SLuca Coelho mac = mvmsta->mac_id_n_color & FW_CTXT_ID_MSK; 2747d9d0d56SLuca Coelho 2757d9d0d56SLuca Coelho if (time_after(jiffies, mvm->tcm.ts + MVM_TCM_PERIOD)) 2767d9d0d56SLuca Coelho schedule_delayed_work(&mvm->tcm.work, 0); 2777d9d0d56SLuca Coelho mdata = &mvm->tcm.data[mac]; 2787d9d0d56SLuca Coelho mdata->rx.pkts[ac]++; 2797d9d0d56SLuca Coelho 2807d9d0d56SLuca Coelho /* count the airtime only once for each ampdu */ 2817d9d0d56SLuca Coelho if (mdata->rx.last_ampdu_ref != mvm->ampdu_ref) { 2827d9d0d56SLuca Coelho mdata->rx.last_ampdu_ref = mvm->ampdu_ref; 2837d9d0d56SLuca Coelho mdata->rx.airtime += le16_to_cpu(phy_info->frame_time); 2847d9d0d56SLuca Coelho } 2857d9d0d56SLuca Coelho 2867d9d0d56SLuca Coelho if (!(rate_n_flags & (RATE_MCS_HT_MSK | RATE_MCS_VHT_MSK))) 2877d9d0d56SLuca Coelho return; 2887d9d0d56SLuca Coelho 289b0ffe455SJohannes Berg mvmvif = iwl_mvm_vif_from_mac80211(mvmsta->vif); 290b0ffe455SJohannes Berg 291b0ffe455SJohannes Berg if (mdata->opened_rx_ba_sessions || 292b0ffe455SJohannes Berg mdata->uapsd_nonagg_detect.detected || 293b0ffe455SJohannes Berg (!mvmvif->queue_params[IEEE80211_AC_VO].uapsd && 294b0ffe455SJohannes Berg !mvmvif->queue_params[IEEE80211_AC_VI].uapsd && 295b0ffe455SJohannes Berg !mvmvif->queue_params[IEEE80211_AC_BE].uapsd && 296b0ffe455SJohannes Berg !mvmvif->queue_params[IEEE80211_AC_BK].uapsd) || 297b0ffe455SJohannes Berg mvmsta->sta_id != mvmvif->ap_sta_id) 298b0ffe455SJohannes Berg return; 299b0ffe455SJohannes Berg 300b0ffe455SJohannes Berg if (rate_n_flags & RATE_MCS_HT_MSK) { 301b0ffe455SJohannes Berg thr = thresh_tpt[rate_n_flags & RATE_HT_MCS_RATE_CODE_MSK]; 302b0ffe455SJohannes Berg thr *= 1 + ((rate_n_flags & RATE_HT_MCS_NSS_MSK) >> 303b0ffe455SJohannes Berg RATE_HT_MCS_NSS_POS); 304b0ffe455SJohannes Berg } else { 305b0ffe455SJohannes Berg if (WARN_ON((rate_n_flags & RATE_VHT_MCS_RATE_CODE_MSK) >= 306b0ffe455SJohannes Berg ARRAY_SIZE(thresh_tpt))) 307b0ffe455SJohannes Berg return; 308b0ffe455SJohannes Berg thr = thresh_tpt[rate_n_flags & RATE_VHT_MCS_RATE_CODE_MSK]; 309b0ffe455SJohannes Berg thr *= 1 + ((rate_n_flags & RATE_VHT_MCS_NSS_MSK) >> 310b0ffe455SJohannes Berg RATE_VHT_MCS_NSS_POS); 311b0ffe455SJohannes Berg } 312b0ffe455SJohannes Berg 313b0ffe455SJohannes Berg thr <<= ((rate_n_flags & RATE_MCS_CHAN_WIDTH_MSK) >> 314b0ffe455SJohannes Berg RATE_MCS_CHAN_WIDTH_POS); 315b0ffe455SJohannes Berg 316b0ffe455SJohannes Berg mdata->uapsd_nonagg_detect.rx_bytes += len; 317b0ffe455SJohannes Berg ewma_rate_add(&mdata->uapsd_nonagg_detect.rate, thr); 3187d9d0d56SLuca Coelho } 3197d9d0d56SLuca Coelho 320e705c121SKalle Valo static void iwl_mvm_rx_csum(struct ieee80211_sta *sta, 321e705c121SKalle Valo struct sk_buff *skb, 322e705c121SKalle Valo u32 status) 323e705c121SKalle Valo { 324e705c121SKalle Valo struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta); 325e705c121SKalle Valo struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(mvmsta->vif); 326e705c121SKalle Valo 327e705c121SKalle Valo if (mvmvif->features & NETIF_F_RXCSUM && 328e705c121SKalle Valo status & RX_MPDU_RES_STATUS_CSUM_DONE && 329e705c121SKalle Valo status & RX_MPDU_RES_STATUS_CSUM_OK) 330e705c121SKalle Valo skb->ip_summed = CHECKSUM_UNNECESSARY; 331e705c121SKalle Valo } 332e705c121SKalle Valo 333e705c121SKalle Valo /* 334e705c121SKalle Valo * iwl_mvm_rx_rx_mpdu - REPLY_RX_MPDU_CMD handler 335e705c121SKalle Valo * 336e705c121SKalle Valo * Handles the actual data of the Rx packet from the fw 337e705c121SKalle Valo */ 338e705c121SKalle Valo void iwl_mvm_rx_rx_mpdu(struct iwl_mvm *mvm, struct napi_struct *napi, 339e705c121SKalle Valo struct iwl_rx_cmd_buffer *rxb) 340e705c121SKalle Valo { 341e705c121SKalle Valo struct ieee80211_hdr *hdr; 342e705c121SKalle Valo struct ieee80211_rx_status *rx_status; 343e705c121SKalle Valo struct iwl_rx_packet *pkt = rxb_addr(rxb); 344e705c121SKalle Valo struct iwl_rx_phy_info *phy_info; 345e705c121SKalle Valo struct iwl_rx_mpdu_res_start *rx_res; 346a399f980SJohannes Berg struct ieee80211_sta *sta = NULL; 347e705c121SKalle Valo struct sk_buff *skb; 348e705c121SKalle Valo u32 len; 349e705c121SKalle Valo u32 rate_n_flags; 350e705c121SKalle Valo u32 rx_pkt_status; 351e705c121SKalle Valo u8 crypt_len = 0; 35216e4dd8fSLuca Coelho bool take_ref; 353e705c121SKalle Valo 354e705c121SKalle Valo phy_info = &mvm->last_phy_info; 355e705c121SKalle Valo rx_res = (struct iwl_rx_mpdu_res_start *)pkt->data; 356e705c121SKalle Valo hdr = (struct ieee80211_hdr *)(pkt->data + sizeof(*rx_res)); 357e705c121SKalle Valo len = le16_to_cpu(rx_res->byte_count); 358e705c121SKalle Valo rx_pkt_status = le32_to_cpup((__le32 *) 359e705c121SKalle Valo (pkt->data + sizeof(*rx_res) + len)); 360e705c121SKalle Valo 361e705c121SKalle Valo /* Dont use dev_alloc_skb(), we'll have enough headroom once 362e705c121SKalle Valo * ieee80211_hdr pulled. 363e705c121SKalle Valo */ 364e705c121SKalle Valo skb = alloc_skb(128, GFP_ATOMIC); 365e705c121SKalle Valo if (!skb) { 366e705c121SKalle Valo IWL_ERR(mvm, "alloc_skb failed\n"); 367e705c121SKalle Valo return; 368e705c121SKalle Valo } 369e705c121SKalle Valo 370e705c121SKalle Valo rx_status = IEEE80211_SKB_RXCB(skb); 371e705c121SKalle Valo 372e705c121SKalle Valo /* 373e705c121SKalle Valo * drop the packet if it has failed being decrypted by HW 374e705c121SKalle Valo */ 375e705c121SKalle Valo if (iwl_mvm_set_mac80211_rx_flag(mvm, hdr, rx_status, rx_pkt_status, 376e705c121SKalle Valo &crypt_len)) { 377e705c121SKalle Valo IWL_DEBUG_DROP(mvm, "Bad decryption results 0x%08x\n", 378e705c121SKalle Valo rx_pkt_status); 379e705c121SKalle Valo kfree_skb(skb); 380e705c121SKalle Valo return; 381e705c121SKalle Valo } 382e705c121SKalle Valo 383e705c121SKalle Valo /* 384e705c121SKalle Valo * Keep packets with CRC errors (and with overrun) for monitor mode 385e705c121SKalle Valo * (otherwise the firmware discards them) but mark them as bad. 386e705c121SKalle Valo */ 387e705c121SKalle Valo if (!(rx_pkt_status & RX_MPDU_RES_STATUS_CRC_OK) || 388e705c121SKalle Valo !(rx_pkt_status & RX_MPDU_RES_STATUS_OVERRUN_OK)) { 389e705c121SKalle Valo IWL_DEBUG_RX(mvm, "Bad CRC or FIFO: 0x%08X.\n", rx_pkt_status); 390e705c121SKalle Valo rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; 391e705c121SKalle Valo } 392e705c121SKalle Valo 393e705c121SKalle Valo /* This will be used in several places later */ 394e705c121SKalle Valo rate_n_flags = le32_to_cpu(phy_info->rate_n_flags); 395e705c121SKalle Valo 396e705c121SKalle Valo /* rx_status carries information about the packet to mac80211 */ 397e705c121SKalle Valo rx_status->mactime = le64_to_cpu(phy_info->timestamp); 398e705c121SKalle Valo rx_status->device_timestamp = le32_to_cpu(phy_info->system_timestamp); 399e705c121SKalle Valo rx_status->band = 400e705c121SKalle Valo (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_BAND_24)) ? 40157fbcce3SJohannes Berg NL80211_BAND_2GHZ : NL80211_BAND_5GHZ; 402e705c121SKalle Valo rx_status->freq = 403e705c121SKalle Valo ieee80211_channel_to_frequency(le16_to_cpu(phy_info->channel), 404e705c121SKalle Valo rx_status->band); 40577fe7395SSara Sharon 40677fe7395SSara Sharon /* TSF as indicated by the firmware is at INA time */ 40777fe7395SSara Sharon rx_status->flag |= RX_FLAG_MACTIME_PLCP_START; 408e705c121SKalle Valo 409e705c121SKalle Valo iwl_mvm_get_signal_strength(mvm, phy_info, rx_status); 410e705c121SKalle Valo 411e705c121SKalle Valo IWL_DEBUG_STATS_LIMIT(mvm, "Rssi %d, TSF %llu\n", rx_status->signal, 412e705c121SKalle Valo (unsigned long long)rx_status->mactime); 413e705c121SKalle Valo 414e705c121SKalle Valo rcu_read_lock(); 415a399f980SJohannes Berg if (rx_pkt_status & RX_MPDU_RES_STATUS_SRC_STA_FOUND) { 416a399f980SJohannes Berg u32 id = rx_pkt_status & RX_MPDU_RES_STATUS_STA_ID_MSK; 417a399f980SJohannes Berg 418a399f980SJohannes Berg id >>= RX_MDPU_RES_STATUS_STA_ID_SHIFT; 419a399f980SJohannes Berg 4200ae98812SSara Sharon if (!WARN_ON_ONCE(id >= ARRAY_SIZE(mvm->fw_id_to_mac_id))) { 421a399f980SJohannes Berg sta = rcu_dereference(mvm->fw_id_to_mac_id[id]); 422a399f980SJohannes Berg if (IS_ERR(sta)) 423a399f980SJohannes Berg sta = NULL; 424a399f980SJohannes Berg } 425a399f980SJohannes Berg } else if (!is_multicast_ether_addr(hdr->addr2)) { 426a399f980SJohannes Berg /* This is fine since we prevent two stations with the same 427a399f980SJohannes Berg * address from being added. 428e705c121SKalle Valo */ 429a399f980SJohannes Berg sta = ieee80211_find_sta_by_ifaddr(mvm->hw, hdr->addr2, NULL); 430e705c121SKalle Valo } 431e705c121SKalle Valo 432e705c121SKalle Valo if (sta) { 433e705c121SKalle Valo struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta); 434d3a108a4SAndrei Otcheretianski struct ieee80211_vif *tx_blocked_vif = 435d3a108a4SAndrei Otcheretianski rcu_dereference(mvm->csa_tx_blocked_vif); 4366c042d75SSara Sharon struct iwl_fw_dbg_trigger_tlv *trig; 4376c042d75SSara Sharon struct ieee80211_vif *vif = mvmsta->vif; 438e705c121SKalle Valo 439a399f980SJohannes Berg /* We have tx blocked stations (with CS bit). If we heard 440a399f980SJohannes Berg * frames from a blocked station on a new channel we can 441a399f980SJohannes Berg * TX to it again. 442a399f980SJohannes Berg */ 4436c042d75SSara Sharon if (unlikely(tx_blocked_vif) && vif == tx_blocked_vif) { 444d3a108a4SAndrei Otcheretianski struct iwl_mvm_vif *mvmvif = 445d3a108a4SAndrei Otcheretianski iwl_mvm_vif_from_mac80211(tx_blocked_vif); 446d3a108a4SAndrei Otcheretianski 447d3a108a4SAndrei Otcheretianski if (mvmvif->csa_target_freq == rx_status->freq) 448d3a108a4SAndrei Otcheretianski iwl_mvm_sta_modify_disable_tx_ap(mvm, sta, 449d3a108a4SAndrei Otcheretianski false); 450d3a108a4SAndrei Otcheretianski } 451a399f980SJohannes Berg 452ecaf71deSGregory Greenman rs_update_last_rssi(mvm, mvmsta, rx_status); 453e705c121SKalle Valo 4546c042d75SSara Sharon trig = iwl_fw_dbg_trigger_on(&mvm->fwrt, 4556c042d75SSara Sharon ieee80211_vif_to_wdev(vif), 4566c042d75SSara Sharon FW_DBG_TRIGGER_RSSI); 4576c042d75SSara Sharon 4586c042d75SSara Sharon if (trig && ieee80211_is_beacon(hdr->frame_control)) { 459e705c121SKalle Valo struct iwl_fw_dbg_trigger_low_rssi *rssi_trig; 460e705c121SKalle Valo s32 rssi; 461e705c121SKalle Valo 462e705c121SKalle Valo rssi_trig = (void *)trig->data; 463e705c121SKalle Valo rssi = le32_to_cpu(rssi_trig->rssi); 464e705c121SKalle Valo 4656c042d75SSara Sharon if (rx_status->signal < rssi) 4667174beb6SJohannes Berg iwl_fw_dbg_collect_trig(&mvm->fwrt, trig, 4677174beb6SJohannes Berg NULL); 468e705c121SKalle Valo } 469e705c121SKalle Valo 4707d9d0d56SLuca Coelho if (!mvm->tcm.paused && len >= sizeof(*hdr) && 4717d9d0d56SLuca Coelho !is_multicast_ether_addr(hdr->addr1) && 4727d9d0d56SLuca Coelho ieee80211_is_data(hdr->frame_control)) 4737d9d0d56SLuca Coelho iwl_mvm_rx_handle_tcm(mvm, sta, hdr, len, phy_info, 4747d9d0d56SLuca Coelho rate_n_flags); 4757d9d0d56SLuca Coelho 476a399f980SJohannes Berg if (ieee80211_is_data(hdr->frame_control)) 477e705c121SKalle Valo iwl_mvm_rx_csum(sta, skb, rx_pkt_status); 478a399f980SJohannes Berg } 479e705c121SKalle Valo rcu_read_unlock(); 480e705c121SKalle Valo 481e705c121SKalle Valo /* set the preamble flag if appropriate */ 482e705c121SKalle Valo if (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_SHORT_PREAMBLE)) 4837fdd69c5SJohannes Berg rx_status->enc_flags |= RX_ENC_FLAG_SHORTPRE; 484e705c121SKalle Valo 485e705c121SKalle Valo if (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_AGG)) { 486e705c121SKalle Valo /* 487e705c121SKalle Valo * We know which subframes of an A-MPDU belong 488e705c121SKalle Valo * together since we get a single PHY response 489e705c121SKalle Valo * from the firmware for all of them 490e705c121SKalle Valo */ 491e705c121SKalle Valo rx_status->flag |= RX_FLAG_AMPDU_DETAILS; 492e705c121SKalle Valo rx_status->ampdu_reference = mvm->ampdu_ref; 493e705c121SKalle Valo } 494e705c121SKalle Valo 495e705c121SKalle Valo /* Set up the HT phy flags */ 496e705c121SKalle Valo switch (rate_n_flags & RATE_MCS_CHAN_WIDTH_MSK) { 497e705c121SKalle Valo case RATE_MCS_CHAN_WIDTH_20: 498e705c121SKalle Valo break; 499e705c121SKalle Valo case RATE_MCS_CHAN_WIDTH_40: 500da6a4352SJohannes Berg rx_status->bw = RATE_INFO_BW_40; 501e705c121SKalle Valo break; 502e705c121SKalle Valo case RATE_MCS_CHAN_WIDTH_80: 503da6a4352SJohannes Berg rx_status->bw = RATE_INFO_BW_80; 504e705c121SKalle Valo break; 505e705c121SKalle Valo case RATE_MCS_CHAN_WIDTH_160: 506da6a4352SJohannes Berg rx_status->bw = RATE_INFO_BW_160; 507e705c121SKalle Valo break; 508e705c121SKalle Valo } 5094c59ff5aSSara Sharon if (!(rate_n_flags & RATE_MCS_CCK_MSK) && 5104c59ff5aSSara Sharon rate_n_flags & RATE_MCS_SGI_MSK) 5117fdd69c5SJohannes Berg rx_status->enc_flags |= RX_ENC_FLAG_SHORT_GI; 512e705c121SKalle Valo if (rate_n_flags & RATE_HT_MCS_GF_MSK) 5137fdd69c5SJohannes Berg rx_status->enc_flags |= RX_ENC_FLAG_HT_GF; 514e705c121SKalle Valo if (rate_n_flags & RATE_MCS_LDPC_MSK) 5157fdd69c5SJohannes Berg rx_status->enc_flags |= RX_ENC_FLAG_LDPC; 516e705c121SKalle Valo if (rate_n_flags & RATE_MCS_HT_MSK) { 51777e40945SSara Sharon u8 stbc = (rate_n_flags & RATE_MCS_STBC_MSK) >> 518e705c121SKalle Valo RATE_MCS_STBC_POS; 519da6a4352SJohannes Berg rx_status->encoding = RX_ENC_HT; 520e705c121SKalle Valo rx_status->rate_idx = rate_n_flags & RATE_HT_MCS_INDEX_MSK; 5217fdd69c5SJohannes Berg rx_status->enc_flags |= stbc << RX_ENC_FLAG_STBC_SHIFT; 522e705c121SKalle Valo } else if (rate_n_flags & RATE_MCS_VHT_MSK) { 52377e40945SSara Sharon u8 stbc = (rate_n_flags & RATE_MCS_STBC_MSK) >> 524e705c121SKalle Valo RATE_MCS_STBC_POS; 5258613c948SJohannes Berg rx_status->nss = 526e705c121SKalle Valo ((rate_n_flags & RATE_VHT_MCS_NSS_MSK) >> 527e705c121SKalle Valo RATE_VHT_MCS_NSS_POS) + 1; 528e705c121SKalle Valo rx_status->rate_idx = rate_n_flags & RATE_VHT_MCS_RATE_CODE_MSK; 529da6a4352SJohannes Berg rx_status->encoding = RX_ENC_VHT; 5307fdd69c5SJohannes Berg rx_status->enc_flags |= stbc << RX_ENC_FLAG_STBC_SHIFT; 531e705c121SKalle Valo if (rate_n_flags & RATE_MCS_BF_MSK) 5327fdd69c5SJohannes Berg rx_status->enc_flags |= RX_ENC_FLAG_BF; 533e705c121SKalle Valo } else { 534cb2de6bbSSara Sharon int rate = iwl_mvm_legacy_rate_to_mac80211_idx(rate_n_flags, 535e705c121SKalle Valo rx_status->band); 536cb2de6bbSSara Sharon 537cb2de6bbSSara Sharon if (WARN(rate < 0 || rate > 0xFF, 538cb2de6bbSSara Sharon "Invalid rate flags 0x%x, band %d,\n", 539cb2de6bbSSara Sharon rate_n_flags, rx_status->band)) { 540cb2de6bbSSara Sharon kfree_skb(skb); 541cb2de6bbSSara Sharon return; 542cb2de6bbSSara Sharon } 543cb2de6bbSSara Sharon rx_status->rate_idx = rate; 544e705c121SKalle Valo } 545e705c121SKalle Valo 546e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS 547e705c121SKalle Valo iwl_mvm_update_frame_stats(mvm, rate_n_flags, 548e705c121SKalle Valo rx_status->flag & RX_FLAG_AMPDU_DETAILS); 549e705c121SKalle Valo #endif 550a339e918SLuca Coelho 551a339e918SLuca Coelho if (unlikely((ieee80211_is_beacon(hdr->frame_control) || 552a339e918SLuca Coelho ieee80211_is_probe_resp(hdr->frame_control)) && 553a339e918SLuca Coelho mvm->sched_scan_pass_all == SCHED_SCAN_PASS_ALL_ENABLED)) 554a339e918SLuca Coelho mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_FOUND; 555a339e918SLuca Coelho 55643ec72b7SJohannes Berg if (unlikely(ieee80211_is_beacon(hdr->frame_control) || 55743ec72b7SJohannes Berg ieee80211_is_probe_resp(hdr->frame_control))) 55843ec72b7SJohannes Berg rx_status->boottime_ns = ktime_get_boot_ns(); 55943ec72b7SJohannes Berg 56016e4dd8fSLuca Coelho /* Take a reference briefly to kick off a d0i3 entry delay so 56116e4dd8fSLuca Coelho * we can handle bursts of RX packets without toggling the 56216e4dd8fSLuca Coelho * state too often. But don't do this for beacons if we are 56316e4dd8fSLuca Coelho * going to idle because the beacon filtering changes we make 56416e4dd8fSLuca Coelho * cause the firmware to send us collateral beacons. */ 56516e4dd8fSLuca Coelho take_ref = !(test_bit(STATUS_TRANS_GOING_IDLE, &mvm->trans->status) && 56616e4dd8fSLuca Coelho ieee80211_is_beacon(hdr->frame_control)); 56716e4dd8fSLuca Coelho 56816e4dd8fSLuca Coelho if (take_ref) 56916e4dd8fSLuca Coelho iwl_mvm_ref(mvm, IWL_MVM_REF_RX); 57016e4dd8fSLuca Coelho 57143ec72b7SJohannes Berg iwl_mvm_pass_packet_to_mac80211(mvm, sta, napi, skb, hdr, len, 572bdbc58abSDan Carpenter crypt_len, rxb); 57316e4dd8fSLuca Coelho 57416e4dd8fSLuca Coelho if (take_ref) 57516e4dd8fSLuca Coelho iwl_mvm_unref(mvm, IWL_MVM_REF_RX); 576e705c121SKalle Valo } 577e705c121SKalle Valo 578e705c121SKalle Valo struct iwl_mvm_stat_data { 579e705c121SKalle Valo struct iwl_mvm *mvm; 580e705c121SKalle Valo __le32 mac_id; 581e705c121SKalle Valo u8 beacon_filter_average_energy; 5820e7ac018SSara Sharon void *general; 583e705c121SKalle Valo }; 584e705c121SKalle Valo 585e705c121SKalle Valo static void iwl_mvm_stat_iterator(void *_data, u8 *mac, 586e705c121SKalle Valo struct ieee80211_vif *vif) 587e705c121SKalle Valo { 588e705c121SKalle Valo struct iwl_mvm_stat_data *data = _data; 589e705c121SKalle Valo struct iwl_mvm *mvm = data->mvm; 590e705c121SKalle Valo int sig = -data->beacon_filter_average_energy; 591e705c121SKalle Valo int last_event; 592e705c121SKalle Valo int thold = vif->bss_conf.cqm_rssi_thold; 593e705c121SKalle Valo int hyst = vif->bss_conf.cqm_rssi_hyst; 594e705c121SKalle Valo u16 id = le32_to_cpu(data->mac_id); 595e705c121SKalle Valo struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); 59655ed14cdSEmmanuel Grumbach u16 vif_id = mvmvif->id; 597e705c121SKalle Valo 598e705c121SKalle Valo /* This doesn't need the MAC ID check since it's not taking the 599e705c121SKalle Valo * data copied into the "data" struct, but rather the data from 600e705c121SKalle Valo * the notification directly. 601e705c121SKalle Valo */ 6020e7ac018SSara Sharon if (iwl_mvm_is_cdb_supported(mvm)) { 6030e7ac018SSara Sharon struct mvm_statistics_general_cdb *general = 6040e7ac018SSara Sharon data->general; 6050e7ac018SSara Sharon 606e705c121SKalle Valo mvmvif->beacon_stats.num_beacons = 6070e7ac018SSara Sharon le32_to_cpu(general->beacon_counter[vif_id]); 608e705c121SKalle Valo mvmvif->beacon_stats.avg_signal = 6090e7ac018SSara Sharon -general->beacon_average_energy[vif_id]; 6100e7ac018SSara Sharon } else { 6110e7ac018SSara Sharon struct mvm_statistics_general_v8 *general = 6120e7ac018SSara Sharon data->general; 6130e7ac018SSara Sharon 6140e7ac018SSara Sharon mvmvif->beacon_stats.num_beacons = 6150e7ac018SSara Sharon le32_to_cpu(general->beacon_counter[vif_id]); 6160e7ac018SSara Sharon mvmvif->beacon_stats.avg_signal = 6170e7ac018SSara Sharon -general->beacon_average_energy[vif_id]; 6180e7ac018SSara Sharon } 619e705c121SKalle Valo 620e705c121SKalle Valo if (mvmvif->id != id) 621e705c121SKalle Valo return; 622e705c121SKalle Valo 623e705c121SKalle Valo if (vif->type != NL80211_IFTYPE_STATION) 624e705c121SKalle Valo return; 625e705c121SKalle Valo 626e705c121SKalle Valo if (sig == 0) { 627e705c121SKalle Valo IWL_DEBUG_RX(mvm, "RSSI is 0 - skip signal based decision\n"); 628e705c121SKalle Valo return; 629e705c121SKalle Valo } 630e705c121SKalle Valo 631e705c121SKalle Valo mvmvif->bf_data.ave_beacon_signal = sig; 632e705c121SKalle Valo 633e705c121SKalle Valo /* BT Coex */ 634e705c121SKalle Valo if (mvmvif->bf_data.bt_coex_min_thold != 635e705c121SKalle Valo mvmvif->bf_data.bt_coex_max_thold) { 636e705c121SKalle Valo last_event = mvmvif->bf_data.last_bt_coex_event; 637e705c121SKalle Valo if (sig > mvmvif->bf_data.bt_coex_max_thold && 638e705c121SKalle Valo (last_event <= mvmvif->bf_data.bt_coex_min_thold || 639e705c121SKalle Valo last_event == 0)) { 640e705c121SKalle Valo mvmvif->bf_data.last_bt_coex_event = sig; 641e705c121SKalle Valo IWL_DEBUG_RX(mvm, "cqm_iterator bt coex high %d\n", 642e705c121SKalle Valo sig); 643e705c121SKalle Valo iwl_mvm_bt_rssi_event(mvm, vif, RSSI_EVENT_HIGH); 644e705c121SKalle Valo } else if (sig < mvmvif->bf_data.bt_coex_min_thold && 645e705c121SKalle Valo (last_event >= mvmvif->bf_data.bt_coex_max_thold || 646e705c121SKalle Valo last_event == 0)) { 647e705c121SKalle Valo mvmvif->bf_data.last_bt_coex_event = sig; 648e705c121SKalle Valo IWL_DEBUG_RX(mvm, "cqm_iterator bt coex low %d\n", 649e705c121SKalle Valo sig); 650e705c121SKalle Valo iwl_mvm_bt_rssi_event(mvm, vif, RSSI_EVENT_LOW); 651e705c121SKalle Valo } 652e705c121SKalle Valo } 653e705c121SKalle Valo 654e705c121SKalle Valo if (!(vif->driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)) 655e705c121SKalle Valo return; 656e705c121SKalle Valo 657e705c121SKalle Valo /* CQM Notification */ 658e705c121SKalle Valo last_event = mvmvif->bf_data.last_cqm_event; 659e705c121SKalle Valo if (thold && sig < thold && (last_event == 0 || 660e705c121SKalle Valo sig < last_event - hyst)) { 661e705c121SKalle Valo mvmvif->bf_data.last_cqm_event = sig; 662e705c121SKalle Valo IWL_DEBUG_RX(mvm, "cqm_iterator cqm low %d\n", 663e705c121SKalle Valo sig); 664e705c121SKalle Valo ieee80211_cqm_rssi_notify( 665e705c121SKalle Valo vif, 666e705c121SKalle Valo NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW, 667769f07d8SAndrzej Zaborowski sig, 668e705c121SKalle Valo GFP_KERNEL); 669e705c121SKalle Valo } else if (sig > thold && 670e705c121SKalle Valo (last_event == 0 || sig > last_event + hyst)) { 671e705c121SKalle Valo mvmvif->bf_data.last_cqm_event = sig; 672e705c121SKalle Valo IWL_DEBUG_RX(mvm, "cqm_iterator cqm high %d\n", 673e705c121SKalle Valo sig); 674e705c121SKalle Valo ieee80211_cqm_rssi_notify( 675e705c121SKalle Valo vif, 676e705c121SKalle Valo NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH, 677769f07d8SAndrzej Zaborowski sig, 678e705c121SKalle Valo GFP_KERNEL); 679e705c121SKalle Valo } 680e705c121SKalle Valo } 681e705c121SKalle Valo 682e705c121SKalle Valo static inline void 683e705c121SKalle Valo iwl_mvm_rx_stats_check_trigger(struct iwl_mvm *mvm, struct iwl_rx_packet *pkt) 684e705c121SKalle Valo { 685e705c121SKalle Valo struct iwl_fw_dbg_trigger_tlv *trig; 686e705c121SKalle Valo struct iwl_fw_dbg_trigger_stats *trig_stats; 687e705c121SKalle Valo u32 trig_offset, trig_thold; 688e705c121SKalle Valo 6896c042d75SSara Sharon trig = iwl_fw_dbg_trigger_on(&mvm->fwrt, NULL, FW_DBG_TRIGGER_STATS); 6906c042d75SSara Sharon if (!trig) 691e705c121SKalle Valo return; 692e705c121SKalle Valo 693e705c121SKalle Valo trig_stats = (void *)trig->data; 694e705c121SKalle Valo 695e705c121SKalle Valo trig_offset = le32_to_cpu(trig_stats->stop_offset); 696e705c121SKalle Valo trig_thold = le32_to_cpu(trig_stats->stop_threshold); 697e705c121SKalle Valo 698e705c121SKalle Valo if (WARN_ON_ONCE(trig_offset >= iwl_rx_packet_payload_len(pkt))) 699e705c121SKalle Valo return; 700e705c121SKalle Valo 701e705c121SKalle Valo if (le32_to_cpup((__le32 *) (pkt->data + trig_offset)) < trig_thold) 702e705c121SKalle Valo return; 703e705c121SKalle Valo 7047174beb6SJohannes Berg iwl_fw_dbg_collect_trig(&mvm->fwrt, trig, NULL); 705e705c121SKalle Valo } 706e705c121SKalle Valo 707e705c121SKalle Valo void iwl_mvm_handle_rx_statistics(struct iwl_mvm *mvm, 708e705c121SKalle Valo struct iwl_rx_packet *pkt) 709e705c121SKalle Valo { 710e705c121SKalle Valo struct iwl_mvm_stat_data data = { 711e705c121SKalle Valo .mvm = mvm, 712e705c121SKalle Valo }; 7130e7ac018SSara Sharon int expected_size; 714cfbeb598SGoodstein, Mordechay int i; 715cfbeb598SGoodstein, Mordechay u8 *energy; 716b0ffe455SJohannes Berg __le32 *bytes; 7177d9d0d56SLuca Coelho __le32 *air_time; 718678d9b6dSLiad Kaufman __le32 flags; 7190e7ac018SSara Sharon 720678d9b6dSLiad Kaufman if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 721678d9b6dSLiad Kaufman if (iwl_mvm_has_new_rx_api(mvm)) 7220e7ac018SSara Sharon expected_size = sizeof(struct iwl_notif_statistics_v11); 7230e7ac018SSara Sharon else 7240e7ac018SSara Sharon expected_size = sizeof(struct iwl_notif_statistics_v10); 725678d9b6dSLiad Kaufman } else { 726678d9b6dSLiad Kaufman expected_size = sizeof(struct iwl_notif_statistics_cdb); 727678d9b6dSLiad Kaufman } 728e705c121SKalle Valo 72942fa5e0eSJohannes Berg if (WARN_ONCE(iwl_rx_packet_payload_len(pkt) != expected_size, 73042fa5e0eSJohannes Berg "received invalid statistics size (%d)!\n", 73142fa5e0eSJohannes Berg iwl_rx_packet_payload_len(pkt))) 7326a90f85aSLuca Coelho return; 733e705c121SKalle Valo 734678d9b6dSLiad Kaufman if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 735678d9b6dSLiad Kaufman struct iwl_notif_statistics_v11 *stats = (void *)&pkt->data; 736678d9b6dSLiad Kaufman 737e705c121SKalle Valo data.mac_id = stats->rx.general.mac_id; 738e705c121SKalle Valo data.beacon_filter_average_energy = 7390e7ac018SSara Sharon stats->general.common.beacon_filter_average_energy; 740e705c121SKalle Valo 741678d9b6dSLiad Kaufman mvm->rx_stats_v3 = stats->rx; 742e705c121SKalle Valo 743678d9b6dSLiad Kaufman mvm->radio_stats.rx_time = 744678d9b6dSLiad Kaufman le64_to_cpu(stats->general.common.rx_time); 745678d9b6dSLiad Kaufman mvm->radio_stats.tx_time = 746678d9b6dSLiad Kaufman le64_to_cpu(stats->general.common.tx_time); 747e705c121SKalle Valo mvm->radio_stats.on_time_rf = 7480e7ac018SSara Sharon le64_to_cpu(stats->general.common.on_time_rf); 749e705c121SKalle Valo mvm->radio_stats.on_time_scan = 7500e7ac018SSara Sharon le64_to_cpu(stats->general.common.on_time_scan); 751e705c121SKalle Valo 752e705c121SKalle Valo data.general = &stats->general; 753cfbeb598SGoodstein, Mordechay 754678d9b6dSLiad Kaufman flags = stats->flag; 755678d9b6dSLiad Kaufman } else { 756678d9b6dSLiad Kaufman struct iwl_notif_statistics_cdb *stats = (void *)&pkt->data; 757678d9b6dSLiad Kaufman 758678d9b6dSLiad Kaufman data.mac_id = stats->rx.general.mac_id; 759678d9b6dSLiad Kaufman data.beacon_filter_average_energy = 760678d9b6dSLiad Kaufman stats->general.common.beacon_filter_average_energy; 761678d9b6dSLiad Kaufman 762678d9b6dSLiad Kaufman mvm->rx_stats = stats->rx; 763678d9b6dSLiad Kaufman 764678d9b6dSLiad Kaufman mvm->radio_stats.rx_time = 765678d9b6dSLiad Kaufman le64_to_cpu(stats->general.common.rx_time); 766678d9b6dSLiad Kaufman mvm->radio_stats.tx_time = 767678d9b6dSLiad Kaufman le64_to_cpu(stats->general.common.tx_time); 768678d9b6dSLiad Kaufman mvm->radio_stats.on_time_rf = 769678d9b6dSLiad Kaufman le64_to_cpu(stats->general.common.on_time_rf); 770678d9b6dSLiad Kaufman mvm->radio_stats.on_time_scan = 771678d9b6dSLiad Kaufman le64_to_cpu(stats->general.common.on_time_scan); 772678d9b6dSLiad Kaufman 773678d9b6dSLiad Kaufman data.general = &stats->general; 774678d9b6dSLiad Kaufman 775678d9b6dSLiad Kaufman flags = stats->flag; 776678d9b6dSLiad Kaufman } 777678d9b6dSLiad Kaufman 778cfbeb598SGoodstein, Mordechay iwl_mvm_rx_stats_check_trigger(mvm, pkt); 779cfbeb598SGoodstein, Mordechay 780cfbeb598SGoodstein, Mordechay ieee80211_iterate_active_interfaces(mvm->hw, 781cfbeb598SGoodstein, Mordechay IEEE80211_IFACE_ITER_NORMAL, 782cfbeb598SGoodstein, Mordechay iwl_mvm_stat_iterator, 783cfbeb598SGoodstein, Mordechay &data); 784cfbeb598SGoodstein, Mordechay 785cfbeb598SGoodstein, Mordechay if (!iwl_mvm_has_new_rx_api(mvm)) 786cfbeb598SGoodstein, Mordechay return; 787988b5968SSara Sharon 788678d9b6dSLiad Kaufman if (!iwl_mvm_has_new_rx_stats_api(mvm)) { 789678d9b6dSLiad Kaufman struct iwl_notif_statistics_v11 *v11 = (void *)&pkt->data; 7900e7ac018SSara Sharon 7910e7ac018SSara Sharon energy = (void *)&v11->load_stats.avg_energy; 792b0ffe455SJohannes Berg bytes = (void *)&v11->load_stats.byte_count; 7930e7ac018SSara Sharon air_time = (void *)&v11->load_stats.air_time; 7940e7ac018SSara Sharon } else { 795678d9b6dSLiad Kaufman struct iwl_notif_statistics_cdb *stats = (void *)&pkt->data; 796678d9b6dSLiad Kaufman 7970e7ac018SSara Sharon energy = (void *)&stats->load_stats.avg_energy; 798b0ffe455SJohannes Berg bytes = (void *)&stats->load_stats.byte_count; 7990e7ac018SSara Sharon air_time = (void *)&stats->load_stats.air_time; 8000e7ac018SSara Sharon } 801988b5968SSara Sharon 802988b5968SSara Sharon rcu_read_lock(); 8030ae98812SSara Sharon for (i = 0; i < ARRAY_SIZE(mvm->fw_id_to_mac_id); i++) { 804988b5968SSara Sharon struct iwl_mvm_sta *sta; 805988b5968SSara Sharon 8060e7ac018SSara Sharon if (!energy[i]) 807988b5968SSara Sharon continue; 808988b5968SSara Sharon 809988b5968SSara Sharon sta = iwl_mvm_sta_from_staid_rcu(mvm, i); 810988b5968SSara Sharon if (!sta) 811988b5968SSara Sharon continue; 8120e7ac018SSara Sharon sta->avg_energy = energy[i]; 813988b5968SSara Sharon } 814988b5968SSara Sharon rcu_read_unlock(); 8157d9d0d56SLuca Coelho 8167d9d0d56SLuca Coelho /* 8177d9d0d56SLuca Coelho * Don't update in case the statistics are not cleared, since 8187d9d0d56SLuca Coelho * we will end up counting twice the same airtime, once in TCM 8197d9d0d56SLuca Coelho * request and once in statistics notification. 8207d9d0d56SLuca Coelho */ 8217d9d0d56SLuca Coelho if (!(le32_to_cpu(flags) & IWL_STATISTICS_REPLY_FLG_CLEAR)) 8227d9d0d56SLuca Coelho return; 8237d9d0d56SLuca Coelho 8247d9d0d56SLuca Coelho spin_lock(&mvm->tcm.lock); 8257d9d0d56SLuca Coelho for (i = 0; i < NUM_MAC_INDEX_DRIVER; i++) { 8267d9d0d56SLuca Coelho struct iwl_mvm_tcm_mac *mdata = &mvm->tcm.data[i]; 8277d9d0d56SLuca Coelho u32 airtime = le32_to_cpu(air_time[i]); 828b0ffe455SJohannes Berg u32 rx_bytes = le32_to_cpu(bytes[i]); 829b0ffe455SJohannes Berg 830b0ffe455SJohannes Berg mdata->uapsd_nonagg_detect.rx_bytes += rx_bytes; 831b0ffe455SJohannes Berg if (airtime) { 832b0ffe455SJohannes Berg /* re-init every time to store rate from FW */ 833b0ffe455SJohannes Berg ewma_rate_init(&mdata->uapsd_nonagg_detect.rate); 834b0ffe455SJohannes Berg ewma_rate_add(&mdata->uapsd_nonagg_detect.rate, 835b0ffe455SJohannes Berg rx_bytes * 8 / airtime); 836b0ffe455SJohannes Berg } 8377d9d0d56SLuca Coelho 8387d9d0d56SLuca Coelho mdata->rx.airtime += airtime; 8397d9d0d56SLuca Coelho } 8407d9d0d56SLuca Coelho spin_unlock(&mvm->tcm.lock); 841e705c121SKalle Valo } 842e705c121SKalle Valo 843e705c121SKalle Valo void iwl_mvm_rx_statistics(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb) 844e705c121SKalle Valo { 845e705c121SKalle Valo iwl_mvm_handle_rx_statistics(mvm, rxb_addr(rxb)); 846e705c121SKalle Valo } 8473af512d6SSara Sharon 8483af512d6SSara Sharon void iwl_mvm_window_status_notif(struct iwl_mvm *mvm, 8493af512d6SSara Sharon struct iwl_rx_cmd_buffer *rxb) 8503af512d6SSara Sharon { 8513af512d6SSara Sharon struct iwl_rx_packet *pkt = rxb_addr(rxb); 8523af512d6SSara Sharon struct iwl_ba_window_status_notif *notif = (void *)pkt->data; 8533af512d6SSara Sharon int i; 8543af512d6SSara Sharon u32 pkt_len = iwl_rx_packet_payload_len(pkt); 8553af512d6SSara Sharon 8563af512d6SSara Sharon if (WARN_ONCE(pkt_len != sizeof(*notif), 8573af512d6SSara Sharon "Received window status notification of wrong size (%u)\n", 8583af512d6SSara Sharon pkt_len)) 8593af512d6SSara Sharon return; 8603af512d6SSara Sharon 8613af512d6SSara Sharon rcu_read_lock(); 8623af512d6SSara Sharon for (i = 0; i < BA_WINDOW_STREAMS_MAX; i++) { 8633af512d6SSara Sharon struct ieee80211_sta *sta; 8643af512d6SSara Sharon u8 sta_id, tid; 8653af512d6SSara Sharon u64 bitmap; 8663af512d6SSara Sharon u32 ssn; 8673af512d6SSara Sharon u16 ratid; 8683af512d6SSara Sharon u16 received_mpdu; 8693af512d6SSara Sharon 8703af512d6SSara Sharon ratid = le16_to_cpu(notif->ra_tid[i]); 8713af512d6SSara Sharon /* check that this TID is valid */ 8723af512d6SSara Sharon if (!(ratid & BA_WINDOW_STATUS_VALID_MSK)) 8733af512d6SSara Sharon continue; 8743af512d6SSara Sharon 8753af512d6SSara Sharon received_mpdu = le16_to_cpu(notif->mpdu_rx_count[i]); 8763af512d6SSara Sharon if (received_mpdu == 0) 8773af512d6SSara Sharon continue; 8783af512d6SSara Sharon 8793af512d6SSara Sharon tid = ratid & BA_WINDOW_STATUS_TID_MSK; 8803af512d6SSara Sharon /* get the station */ 8813af512d6SSara Sharon sta_id = (ratid & BA_WINDOW_STATUS_STA_ID_MSK) 8823af512d6SSara Sharon >> BA_WINDOW_STATUS_STA_ID_POS; 8833af512d6SSara Sharon sta = rcu_dereference(mvm->fw_id_to_mac_id[sta_id]); 8843af512d6SSara Sharon if (IS_ERR_OR_NULL(sta)) 8853af512d6SSara Sharon continue; 8863af512d6SSara Sharon bitmap = le64_to_cpu(notif->bitmap[i]); 8873af512d6SSara Sharon ssn = le32_to_cpu(notif->start_seq_num[i]); 8883af512d6SSara Sharon 8893af512d6SSara Sharon /* update mac80211 with the bitmap for the reordering buffer */ 8903af512d6SSara Sharon ieee80211_mark_rx_ba_filtered_frames(sta, tid, ssn, bitmap, 8913af512d6SSara Sharon received_mpdu); 8923af512d6SSara Sharon } 8933af512d6SSara Sharon rcu_read_unlock(); 8943af512d6SSara Sharon } 895