1c378f247SStanislaw Gruszka /* 2c378f247SStanislaw Gruszka * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> 3c378f247SStanislaw Gruszka * Copyright (C) 2018 Stanislaw Gruszka <stf_xl@wp.pl> 4c378f247SStanislaw Gruszka * 5c378f247SStanislaw Gruszka * Permission to use, copy, modify, and/or distribute this software for any 6c378f247SStanislaw Gruszka * purpose with or without fee is hereby granted, provided that the above 7c378f247SStanislaw Gruszka * copyright notice and this permission notice appear in all copies. 8c378f247SStanislaw Gruszka * 9c378f247SStanislaw Gruszka * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10c378f247SStanislaw Gruszka * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11c378f247SStanislaw Gruszka * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12c378f247SStanislaw Gruszka * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13c378f247SStanislaw Gruszka * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14c378f247SStanislaw Gruszka * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15c378f247SStanislaw Gruszka * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16c378f247SStanislaw Gruszka */ 17c378f247SStanislaw Gruszka 187a07adcdSLorenzo Bianconi #include "mt76x02.h" 193e2342edSLorenzo Bianconi #include "mt76x02_trace.h" 20c378f247SStanislaw Gruszka 21c378f247SStanislaw Gruszka enum mt76x02_cipher_type 22c378f247SStanislaw Gruszka mt76x02_mac_get_key_info(struct ieee80211_key_conf *key, u8 *key_data) 23c378f247SStanislaw Gruszka { 24c378f247SStanislaw Gruszka memset(key_data, 0, 32); 25c378f247SStanislaw Gruszka if (!key) 26c378f247SStanislaw Gruszka return MT_CIPHER_NONE; 27c378f247SStanislaw Gruszka 28c378f247SStanislaw Gruszka if (key->keylen > 32) 29c378f247SStanislaw Gruszka return MT_CIPHER_NONE; 30c378f247SStanislaw Gruszka 31c378f247SStanislaw Gruszka memcpy(key_data, key->key, key->keylen); 32c378f247SStanislaw Gruszka 33c378f247SStanislaw Gruszka switch (key->cipher) { 34c378f247SStanislaw Gruszka case WLAN_CIPHER_SUITE_WEP40: 35c378f247SStanislaw Gruszka return MT_CIPHER_WEP40; 36c378f247SStanislaw Gruszka case WLAN_CIPHER_SUITE_WEP104: 37c378f247SStanislaw Gruszka return MT_CIPHER_WEP104; 38c378f247SStanislaw Gruszka case WLAN_CIPHER_SUITE_TKIP: 39c378f247SStanislaw Gruszka return MT_CIPHER_TKIP; 40c378f247SStanislaw Gruszka case WLAN_CIPHER_SUITE_CCMP: 41c378f247SStanislaw Gruszka return MT_CIPHER_AES_CCMP; 42c378f247SStanislaw Gruszka default: 43c378f247SStanislaw Gruszka return MT_CIPHER_NONE; 44c378f247SStanislaw Gruszka } 45c378f247SStanislaw Gruszka } 46c378f247SStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_get_key_info); 47047aed1cSStanislaw Gruszka 488d66af49SLorenzo Bianconi int mt76x02_mac_shared_key_setup(struct mt76x02_dev *dev, u8 vif_idx, 498d66af49SLorenzo Bianconi u8 key_idx, struct ieee80211_key_conf *key) 50047aed1cSStanislaw Gruszka { 51047aed1cSStanislaw Gruszka enum mt76x02_cipher_type cipher; 52047aed1cSStanislaw Gruszka u8 key_data[32]; 53047aed1cSStanislaw Gruszka u32 val; 54047aed1cSStanislaw Gruszka 55047aed1cSStanislaw Gruszka cipher = mt76x02_mac_get_key_info(key, key_data); 56047aed1cSStanislaw Gruszka if (cipher == MT_CIPHER_NONE && key) 57047aed1cSStanislaw Gruszka return -EOPNOTSUPP; 58047aed1cSStanislaw Gruszka 598d66af49SLorenzo Bianconi val = mt76_rr(dev, MT_SKEY_MODE(vif_idx)); 60047aed1cSStanislaw Gruszka val &= ~(MT_SKEY_MODE_MASK << MT_SKEY_MODE_SHIFT(vif_idx, key_idx)); 61047aed1cSStanislaw Gruszka val |= cipher << MT_SKEY_MODE_SHIFT(vif_idx, key_idx); 628d66af49SLorenzo Bianconi mt76_wr(dev, MT_SKEY_MODE(vif_idx), val); 63047aed1cSStanislaw Gruszka 648d66af49SLorenzo Bianconi mt76_wr_copy(dev, MT_SKEY(vif_idx, key_idx), key_data, 65047aed1cSStanislaw Gruszka sizeof(key_data)); 66047aed1cSStanislaw Gruszka 67047aed1cSStanislaw Gruszka return 0; 68047aed1cSStanislaw Gruszka } 69047aed1cSStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_shared_key_setup); 7046436b5eSStanislaw Gruszka 718d66af49SLorenzo Bianconi int mt76x02_mac_wcid_set_key(struct mt76x02_dev *dev, u8 idx, 7246436b5eSStanislaw Gruszka struct ieee80211_key_conf *key) 7346436b5eSStanislaw Gruszka { 7446436b5eSStanislaw Gruszka enum mt76x02_cipher_type cipher; 7546436b5eSStanislaw Gruszka u8 key_data[32]; 7646436b5eSStanislaw Gruszka u8 iv_data[8]; 7746436b5eSStanislaw Gruszka 7846436b5eSStanislaw Gruszka cipher = mt76x02_mac_get_key_info(key, key_data); 7946436b5eSStanislaw Gruszka if (cipher == MT_CIPHER_NONE && key) 8046436b5eSStanislaw Gruszka return -EOPNOTSUPP; 8146436b5eSStanislaw Gruszka 828d66af49SLorenzo Bianconi mt76_wr_copy(dev, MT_WCID_KEY(idx), key_data, sizeof(key_data)); 838d66af49SLorenzo Bianconi mt76_rmw_field(dev, MT_WCID_ATTR(idx), MT_WCID_ATTR_PKEY_MODE, cipher); 8446436b5eSStanislaw Gruszka 8546436b5eSStanislaw Gruszka memset(iv_data, 0, sizeof(iv_data)); 8646436b5eSStanislaw Gruszka if (key) { 878d66af49SLorenzo Bianconi mt76_rmw_field(dev, MT_WCID_ATTR(idx), MT_WCID_ATTR_PAIRWISE, 8846436b5eSStanislaw Gruszka !!(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)); 8946436b5eSStanislaw Gruszka iv_data[3] = key->keyidx << 6; 9046436b5eSStanislaw Gruszka if (cipher >= MT_CIPHER_TKIP) 9146436b5eSStanislaw Gruszka iv_data[3] |= 0x20; 9246436b5eSStanislaw Gruszka } 9346436b5eSStanislaw Gruszka 948d66af49SLorenzo Bianconi mt76_wr_copy(dev, MT_WCID_IV(idx), iv_data, sizeof(iv_data)); 9546436b5eSStanislaw Gruszka 9646436b5eSStanislaw Gruszka return 0; 9746436b5eSStanislaw Gruszka } 9846436b5eSStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_wcid_set_key); 9932bb405fSStanislaw Gruszka 1008d66af49SLorenzo Bianconi void mt76x02_mac_wcid_setup(struct mt76x02_dev *dev, u8 idx, 1018d66af49SLorenzo Bianconi u8 vif_idx, u8 *mac) 10232bb405fSStanislaw Gruszka { 10332bb405fSStanislaw Gruszka struct mt76_wcid_addr addr = {}; 10432bb405fSStanislaw Gruszka u32 attr; 10532bb405fSStanislaw Gruszka 10632bb405fSStanislaw Gruszka attr = FIELD_PREP(MT_WCID_ATTR_BSS_IDX, vif_idx & 7) | 10732bb405fSStanislaw Gruszka FIELD_PREP(MT_WCID_ATTR_BSS_IDX_EXT, !!(vif_idx & 8)); 10832bb405fSStanislaw Gruszka 1098d66af49SLorenzo Bianconi mt76_wr(dev, MT_WCID_ATTR(idx), attr); 11032bb405fSStanislaw Gruszka 1118d66af49SLorenzo Bianconi mt76_wr(dev, MT_WCID_TX_RATE(idx), 0); 1128d66af49SLorenzo Bianconi mt76_wr(dev, MT_WCID_TX_RATE(idx) + 4, 0); 11332bb405fSStanislaw Gruszka 11432bb405fSStanislaw Gruszka if (idx >= 128) 11532bb405fSStanislaw Gruszka return; 11632bb405fSStanislaw Gruszka 11732bb405fSStanislaw Gruszka if (mac) 11832bb405fSStanislaw Gruszka memcpy(addr.macaddr, mac, ETH_ALEN); 11932bb405fSStanislaw Gruszka 1208d66af49SLorenzo Bianconi mt76_wr_copy(dev, MT_WCID_ADDR(idx), &addr, sizeof(addr)); 12132bb405fSStanislaw Gruszka } 12232bb405fSStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_wcid_setup); 123516ea2a2SStanislaw Gruszka 1248d66af49SLorenzo Bianconi void mt76x02_mac_wcid_set_drop(struct mt76x02_dev *dev, u8 idx, bool drop) 125516ea2a2SStanislaw Gruszka { 1268d66af49SLorenzo Bianconi u32 val = mt76_rr(dev, MT_WCID_DROP(idx)); 127516ea2a2SStanislaw Gruszka u32 bit = MT_WCID_DROP_MASK(idx); 128516ea2a2SStanislaw Gruszka 129516ea2a2SStanislaw Gruszka /* prevent unnecessary writes */ 130516ea2a2SStanislaw Gruszka if ((val & bit) != (bit * drop)) 1318d66af49SLorenzo Bianconi mt76_wr(dev, MT_WCID_DROP(idx), (val & ~bit) | (bit * drop)); 132516ea2a2SStanislaw Gruszka } 133516ea2a2SStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_wcid_set_drop); 134f5a7f126SStanislaw Gruszka 1358d66af49SLorenzo Bianconi void mt76x02_txq_init(struct mt76x02_dev *dev, struct ieee80211_txq *txq) 136f5a7f126SStanislaw Gruszka { 137f5a7f126SStanislaw Gruszka struct mt76_txq *mtxq; 138f5a7f126SStanislaw Gruszka 139f5a7f126SStanislaw Gruszka if (!txq) 140f5a7f126SStanislaw Gruszka return; 141f5a7f126SStanislaw Gruszka 142f5a7f126SStanislaw Gruszka mtxq = (struct mt76_txq *) txq->drv_priv; 143f5a7f126SStanislaw Gruszka if (txq->sta) { 144f5a7f126SStanislaw Gruszka struct mt76x02_sta *sta; 145f5a7f126SStanislaw Gruszka 146f5a7f126SStanislaw Gruszka sta = (struct mt76x02_sta *) txq->sta->drv_priv; 147f5a7f126SStanislaw Gruszka mtxq->wcid = &sta->wcid; 148f5a7f126SStanislaw Gruszka } else { 149f5a7f126SStanislaw Gruszka struct mt76x02_vif *mvif; 150f5a7f126SStanislaw Gruszka 151f5a7f126SStanislaw Gruszka mvif = (struct mt76x02_vif *) txq->vif->drv_priv; 152f5a7f126SStanislaw Gruszka mtxq->wcid = &mvif->group_wcid; 153f5a7f126SStanislaw Gruszka } 154f5a7f126SStanislaw Gruszka 1558d66af49SLorenzo Bianconi mt76_txq_init(&dev->mt76, txq); 156f5a7f126SStanislaw Gruszka } 157f5a7f126SStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_txq_init); 1585327b5eaSStanislaw Gruszka 159c4ed5088SLorenzo Bianconi static void 160c4ed5088SLorenzo Bianconi mt76x02_mac_fill_txwi(struct mt76x02_txwi *txwi, struct sk_buff *skb, 1610b7da311SStanislaw Gruszka struct ieee80211_sta *sta, int len, u8 nss) 1620b7da311SStanislaw Gruszka { 1630b7da311SStanislaw Gruszka struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 1640b7da311SStanislaw Gruszka struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; 1650b7da311SStanislaw Gruszka u16 txwi_flags = 0; 1660b7da311SStanislaw Gruszka 1670b7da311SStanislaw Gruszka if (info->flags & IEEE80211_TX_CTL_LDPC) 1680b7da311SStanislaw Gruszka txwi->rate |= cpu_to_le16(MT_RXWI_RATE_LDPC); 1690b7da311SStanislaw Gruszka if ((info->flags & IEEE80211_TX_CTL_STBC) && nss == 1) 1700b7da311SStanislaw Gruszka txwi->rate |= cpu_to_le16(MT_RXWI_RATE_STBC); 1710b7da311SStanislaw Gruszka if (nss > 1 && sta && sta->smps_mode == IEEE80211_SMPS_DYNAMIC) 1720b7da311SStanislaw Gruszka txwi_flags |= MT_TXWI_FLAGS_MMPS; 1730b7da311SStanislaw Gruszka if (!(info->flags & IEEE80211_TX_CTL_NO_ACK)) 1740b7da311SStanislaw Gruszka txwi->ack_ctl |= MT_TXWI_ACK_CTL_REQ; 1750b7da311SStanislaw Gruszka if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) 1760b7da311SStanislaw Gruszka txwi->ack_ctl |= MT_TXWI_ACK_CTL_NSEQ; 1770b7da311SStanislaw Gruszka if (info->flags & IEEE80211_TX_CTL_RATE_CTRL_PROBE) 1780b7da311SStanislaw Gruszka txwi->pktid |= MT_TXWI_PKTID_PROBE; 1790b7da311SStanislaw Gruszka if ((info->flags & IEEE80211_TX_CTL_AMPDU) && sta) { 1800b7da311SStanislaw Gruszka u8 ba_size = IEEE80211_MIN_AMPDU_BUF; 1810b7da311SStanislaw Gruszka 1820b7da311SStanislaw Gruszka ba_size <<= sta->ht_cap.ampdu_factor; 1830b7da311SStanislaw Gruszka ba_size = min_t(int, 63, ba_size - 1); 1840b7da311SStanislaw Gruszka if (info->flags & IEEE80211_TX_CTL_RATE_CTRL_PROBE) 1850b7da311SStanislaw Gruszka ba_size = 0; 1860b7da311SStanislaw Gruszka txwi->ack_ctl |= FIELD_PREP(MT_TXWI_ACK_CTL_BA_WINDOW, ba_size); 1870b7da311SStanislaw Gruszka 1880b7da311SStanislaw Gruszka txwi_flags |= MT_TXWI_FLAGS_AMPDU | 1890b7da311SStanislaw Gruszka FIELD_PREP(MT_TXWI_FLAGS_MPDU_DENSITY, 1900b7da311SStanislaw Gruszka sta->ht_cap.ampdu_density); 1910b7da311SStanislaw Gruszka } 1920b7da311SStanislaw Gruszka 1930b7da311SStanislaw Gruszka if (ieee80211_is_probe_resp(hdr->frame_control) || 1940b7da311SStanislaw Gruszka ieee80211_is_beacon(hdr->frame_control)) 1950b7da311SStanislaw Gruszka txwi_flags |= MT_TXWI_FLAGS_TS; 1960b7da311SStanislaw Gruszka 1970b7da311SStanislaw Gruszka txwi->flags |= cpu_to_le16(txwi_flags); 1980b7da311SStanislaw Gruszka txwi->len_ctl = cpu_to_le16(len); 1990b7da311SStanislaw Gruszka } 2000b7da311SStanislaw Gruszka 201c4ed5088SLorenzo Bianconi static __le16 2028d66af49SLorenzo Bianconi mt76x02_mac_tx_rate_val(struct mt76x02_dev *dev, 2035327b5eaSStanislaw Gruszka const struct ieee80211_tx_rate *rate, u8 *nss_val) 2045327b5eaSStanislaw Gruszka { 2055327b5eaSStanislaw Gruszka u16 rateval; 2065327b5eaSStanislaw Gruszka u8 phy, rate_idx; 2075327b5eaSStanislaw Gruszka u8 nss = 1; 2085327b5eaSStanislaw Gruszka u8 bw = 0; 2095327b5eaSStanislaw Gruszka 2105327b5eaSStanislaw Gruszka if (rate->flags & IEEE80211_TX_RC_VHT_MCS) { 2115327b5eaSStanislaw Gruszka rate_idx = rate->idx; 2125327b5eaSStanislaw Gruszka nss = 1 + (rate->idx >> 4); 2135327b5eaSStanislaw Gruszka phy = MT_PHY_TYPE_VHT; 2145327b5eaSStanislaw Gruszka if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH) 2155327b5eaSStanislaw Gruszka bw = 2; 2165327b5eaSStanislaw Gruszka else if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH) 2175327b5eaSStanislaw Gruszka bw = 1; 2185327b5eaSStanislaw Gruszka } else if (rate->flags & IEEE80211_TX_RC_MCS) { 2195327b5eaSStanislaw Gruszka rate_idx = rate->idx; 2205327b5eaSStanislaw Gruszka nss = 1 + (rate->idx >> 3); 2215327b5eaSStanislaw Gruszka phy = MT_PHY_TYPE_HT; 2225327b5eaSStanislaw Gruszka if (rate->flags & IEEE80211_TX_RC_GREEN_FIELD) 2235327b5eaSStanislaw Gruszka phy = MT_PHY_TYPE_HT_GF; 2245327b5eaSStanislaw Gruszka if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH) 2255327b5eaSStanislaw Gruszka bw = 1; 2265327b5eaSStanislaw Gruszka } else { 2275327b5eaSStanislaw Gruszka const struct ieee80211_rate *r; 2288d66af49SLorenzo Bianconi int band = dev->mt76.chandef.chan->band; 2295327b5eaSStanislaw Gruszka u16 val; 2305327b5eaSStanislaw Gruszka 2318d66af49SLorenzo Bianconi r = &dev->mt76.hw->wiphy->bands[band]->bitrates[rate->idx]; 2325327b5eaSStanislaw Gruszka if (rate->flags & IEEE80211_TX_RC_USE_SHORT_PREAMBLE) 2335327b5eaSStanislaw Gruszka val = r->hw_value_short; 2345327b5eaSStanislaw Gruszka else 2355327b5eaSStanislaw Gruszka val = r->hw_value; 2365327b5eaSStanislaw Gruszka 2375327b5eaSStanislaw Gruszka phy = val >> 8; 2385327b5eaSStanislaw Gruszka rate_idx = val & 0xff; 2395327b5eaSStanislaw Gruszka bw = 0; 2405327b5eaSStanislaw Gruszka } 2415327b5eaSStanislaw Gruszka 2425327b5eaSStanislaw Gruszka rateval = FIELD_PREP(MT_RXWI_RATE_INDEX, rate_idx); 2435327b5eaSStanislaw Gruszka rateval |= FIELD_PREP(MT_RXWI_RATE_PHY, phy); 2445327b5eaSStanislaw Gruszka rateval |= FIELD_PREP(MT_RXWI_RATE_BW, bw); 2455327b5eaSStanislaw Gruszka if (rate->flags & IEEE80211_TX_RC_SHORT_GI) 2465327b5eaSStanislaw Gruszka rateval |= MT_RXWI_RATE_SGI; 2475327b5eaSStanislaw Gruszka 2485327b5eaSStanislaw Gruszka *nss_val = nss; 2495327b5eaSStanislaw Gruszka return cpu_to_le16(rateval); 2505327b5eaSStanislaw Gruszka } 2515327b5eaSStanislaw Gruszka 2528d66af49SLorenzo Bianconi void mt76x02_mac_wcid_set_rate(struct mt76x02_dev *dev, struct mt76_wcid *wcid, 2535327b5eaSStanislaw Gruszka const struct ieee80211_tx_rate *rate) 2545327b5eaSStanislaw Gruszka { 2558d66af49SLorenzo Bianconi spin_lock_bh(&dev->mt76.lock); 2565327b5eaSStanislaw Gruszka wcid->tx_rate = mt76x02_mac_tx_rate_val(dev, rate, &wcid->tx_rate_nss); 2575327b5eaSStanislaw Gruszka wcid->tx_rate_set = true; 2588d66af49SLorenzo Bianconi spin_unlock_bh(&dev->mt76.lock); 2595327b5eaSStanislaw Gruszka } 260b490b1dfSStanislaw Gruszka 2618d66af49SLorenzo Bianconi bool mt76x02_mac_load_tx_status(struct mt76x02_dev *dev, 262b490b1dfSStanislaw Gruszka struct mt76x02_tx_status *stat) 263b490b1dfSStanislaw Gruszka { 264b490b1dfSStanislaw Gruszka u32 stat1, stat2; 265b490b1dfSStanislaw Gruszka 2668d66af49SLorenzo Bianconi stat2 = mt76_rr(dev, MT_TX_STAT_FIFO_EXT); 2678d66af49SLorenzo Bianconi stat1 = mt76_rr(dev, MT_TX_STAT_FIFO); 268b490b1dfSStanislaw Gruszka 269b490b1dfSStanislaw Gruszka stat->valid = !!(stat1 & MT_TX_STAT_FIFO_VALID); 270b490b1dfSStanislaw Gruszka if (!stat->valid) 271b490b1dfSStanislaw Gruszka return false; 272b490b1dfSStanislaw Gruszka 273b490b1dfSStanislaw Gruszka stat->success = !!(stat1 & MT_TX_STAT_FIFO_SUCCESS); 274b490b1dfSStanislaw Gruszka stat->aggr = !!(stat1 & MT_TX_STAT_FIFO_AGGR); 275b490b1dfSStanislaw Gruszka stat->ack_req = !!(stat1 & MT_TX_STAT_FIFO_ACKREQ); 276b490b1dfSStanislaw Gruszka stat->wcid = FIELD_GET(MT_TX_STAT_FIFO_WCID, stat1); 277b490b1dfSStanislaw Gruszka stat->rate = FIELD_GET(MT_TX_STAT_FIFO_RATE, stat1); 278b490b1dfSStanislaw Gruszka 279b490b1dfSStanislaw Gruszka stat->retry = FIELD_GET(MT_TX_STAT_FIFO_EXT_RETRY, stat2); 280b490b1dfSStanislaw Gruszka stat->pktid = FIELD_GET(MT_TX_STAT_FIFO_EXT_PKTID, stat2); 281b490b1dfSStanislaw Gruszka 282b490b1dfSStanislaw Gruszka return true; 283b490b1dfSStanislaw Gruszka } 284b490b1dfSStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_load_tx_status); 2857c1f8881SStanislaw Gruszka 2867c1f8881SStanislaw Gruszka static int 2877c1f8881SStanislaw Gruszka mt76x02_mac_process_tx_rate(struct ieee80211_tx_rate *txrate, u16 rate, 2887c1f8881SStanislaw Gruszka enum nl80211_band band) 2897c1f8881SStanislaw Gruszka { 2907c1f8881SStanislaw Gruszka u8 idx = FIELD_GET(MT_RXWI_RATE_INDEX, rate); 2917c1f8881SStanislaw Gruszka 2927c1f8881SStanislaw Gruszka txrate->idx = 0; 2937c1f8881SStanislaw Gruszka txrate->flags = 0; 2947c1f8881SStanislaw Gruszka txrate->count = 1; 2957c1f8881SStanislaw Gruszka 2967c1f8881SStanislaw Gruszka switch (FIELD_GET(MT_RXWI_RATE_PHY, rate)) { 2977c1f8881SStanislaw Gruszka case MT_PHY_TYPE_OFDM: 2987c1f8881SStanislaw Gruszka if (band == NL80211_BAND_2GHZ) 2997c1f8881SStanislaw Gruszka idx += 4; 3007c1f8881SStanislaw Gruszka 3017c1f8881SStanislaw Gruszka txrate->idx = idx; 3027c1f8881SStanislaw Gruszka return 0; 3037c1f8881SStanislaw Gruszka case MT_PHY_TYPE_CCK: 3047c1f8881SStanislaw Gruszka if (idx >= 8) 3057c1f8881SStanislaw Gruszka idx -= 8; 3067c1f8881SStanislaw Gruszka 3077c1f8881SStanislaw Gruszka txrate->idx = idx; 3087c1f8881SStanislaw Gruszka return 0; 3097c1f8881SStanislaw Gruszka case MT_PHY_TYPE_HT_GF: 3107c1f8881SStanislaw Gruszka txrate->flags |= IEEE80211_TX_RC_GREEN_FIELD; 3117c1f8881SStanislaw Gruszka /* fall through */ 3127c1f8881SStanislaw Gruszka case MT_PHY_TYPE_HT: 3137c1f8881SStanislaw Gruszka txrate->flags |= IEEE80211_TX_RC_MCS; 3147c1f8881SStanislaw Gruszka txrate->idx = idx; 3157c1f8881SStanislaw Gruszka break; 3167c1f8881SStanislaw Gruszka case MT_PHY_TYPE_VHT: 3177c1f8881SStanislaw Gruszka txrate->flags |= IEEE80211_TX_RC_VHT_MCS; 3187c1f8881SStanislaw Gruszka txrate->idx = idx; 3197c1f8881SStanislaw Gruszka break; 3207c1f8881SStanislaw Gruszka default: 3217c1f8881SStanislaw Gruszka return -EINVAL; 3227c1f8881SStanislaw Gruszka } 3237c1f8881SStanislaw Gruszka 3247c1f8881SStanislaw Gruszka switch (FIELD_GET(MT_RXWI_RATE_BW, rate)) { 3257c1f8881SStanislaw Gruszka case MT_PHY_BW_20: 3267c1f8881SStanislaw Gruszka break; 3277c1f8881SStanislaw Gruszka case MT_PHY_BW_40: 3287c1f8881SStanislaw Gruszka txrate->flags |= IEEE80211_TX_RC_40_MHZ_WIDTH; 3297c1f8881SStanislaw Gruszka break; 3307c1f8881SStanislaw Gruszka case MT_PHY_BW_80: 3317c1f8881SStanislaw Gruszka txrate->flags |= IEEE80211_TX_RC_80_MHZ_WIDTH; 3327c1f8881SStanislaw Gruszka break; 3337c1f8881SStanislaw Gruszka default: 3347c1f8881SStanislaw Gruszka return -EINVAL; 3357c1f8881SStanislaw Gruszka } 3367c1f8881SStanislaw Gruszka 3377c1f8881SStanislaw Gruszka if (rate & MT_RXWI_RATE_SGI) 3387c1f8881SStanislaw Gruszka txrate->flags |= IEEE80211_TX_RC_SHORT_GI; 3397c1f8881SStanislaw Gruszka 3407c1f8881SStanislaw Gruszka return 0; 3417c1f8881SStanislaw Gruszka } 3427c1f8881SStanislaw Gruszka 3438d66af49SLorenzo Bianconi void mt76x02_mac_write_txwi(struct mt76x02_dev *dev, struct mt76x02_txwi *txwi, 344427f9ebeSLorenzo Bianconi struct sk_buff *skb, struct mt76_wcid *wcid, 345427f9ebeSLorenzo Bianconi struct ieee80211_sta *sta, int len) 346427f9ebeSLorenzo Bianconi { 347427f9ebeSLorenzo Bianconi struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 348427f9ebeSLorenzo Bianconi struct ieee80211_tx_rate *rate = &info->control.rates[0]; 349427f9ebeSLorenzo Bianconi struct ieee80211_key_conf *key = info->control.hw_key; 350427f9ebeSLorenzo Bianconi u16 rate_ht_mask = FIELD_PREP(MT_RXWI_RATE_PHY, BIT(1) | BIT(2)); 351427f9ebeSLorenzo Bianconi u8 nss; 352427f9ebeSLorenzo Bianconi s8 txpwr_adj, max_txpwr_adj; 3538d66af49SLorenzo Bianconi u8 ccmp_pn[8], nstreams = dev->mt76.chainmask & 0xf; 354427f9ebeSLorenzo Bianconi 355427f9ebeSLorenzo Bianconi memset(txwi, 0, sizeof(*txwi)); 356427f9ebeSLorenzo Bianconi 357427f9ebeSLorenzo Bianconi if (wcid) 358427f9ebeSLorenzo Bianconi txwi->wcid = wcid->idx; 359427f9ebeSLorenzo Bianconi else 360427f9ebeSLorenzo Bianconi txwi->wcid = 0xff; 361427f9ebeSLorenzo Bianconi 362427f9ebeSLorenzo Bianconi txwi->pktid = 1; 363427f9ebeSLorenzo Bianconi 364427f9ebeSLorenzo Bianconi if (wcid && wcid->sw_iv && key) { 365427f9ebeSLorenzo Bianconi u64 pn = atomic64_inc_return(&key->tx_pn); 366427f9ebeSLorenzo Bianconi ccmp_pn[0] = pn; 367427f9ebeSLorenzo Bianconi ccmp_pn[1] = pn >> 8; 368427f9ebeSLorenzo Bianconi ccmp_pn[2] = 0; 369427f9ebeSLorenzo Bianconi ccmp_pn[3] = 0x20 | (key->keyidx << 6); 370427f9ebeSLorenzo Bianconi ccmp_pn[4] = pn >> 16; 371427f9ebeSLorenzo Bianconi ccmp_pn[5] = pn >> 24; 372427f9ebeSLorenzo Bianconi ccmp_pn[6] = pn >> 32; 373427f9ebeSLorenzo Bianconi ccmp_pn[7] = pn >> 40; 374427f9ebeSLorenzo Bianconi txwi->iv = *((__le32 *)&ccmp_pn[0]); 375427f9ebeSLorenzo Bianconi txwi->eiv = *((__le32 *)&ccmp_pn[1]); 376427f9ebeSLorenzo Bianconi } 377427f9ebeSLorenzo Bianconi 3788d66af49SLorenzo Bianconi spin_lock_bh(&dev->mt76.lock); 379427f9ebeSLorenzo Bianconi if (wcid && (rate->idx < 0 || !rate->count)) { 380427f9ebeSLorenzo Bianconi txwi->rate = wcid->tx_rate; 381427f9ebeSLorenzo Bianconi max_txpwr_adj = wcid->max_txpwr_adj; 382427f9ebeSLorenzo Bianconi nss = wcid->tx_rate_nss; 383427f9ebeSLorenzo Bianconi } else { 384427f9ebeSLorenzo Bianconi txwi->rate = mt76x02_mac_tx_rate_val(dev, rate, &nss); 385*91be8e8aSLorenzo Bianconi max_txpwr_adj = mt76x02_tx_get_max_txpwr_adj(dev, rate); 386427f9ebeSLorenzo Bianconi } 3878d66af49SLorenzo Bianconi spin_unlock_bh(&dev->mt76.lock); 388427f9ebeSLorenzo Bianconi 389*91be8e8aSLorenzo Bianconi txpwr_adj = mt76x02_tx_get_txpwr_adj(dev, dev->mt76.txpower_conf, 390427f9ebeSLorenzo Bianconi max_txpwr_adj); 391427f9ebeSLorenzo Bianconi txwi->ctl2 = FIELD_PREP(MT_TX_PWR_ADJ, txpwr_adj); 392427f9ebeSLorenzo Bianconi 3938d66af49SLorenzo Bianconi if (nstreams > 1 && mt76_rev(&dev->mt76) >= MT76XX_REV_E4) 394427f9ebeSLorenzo Bianconi txwi->txstream = 0x13; 3958d66af49SLorenzo Bianconi else if (nstreams > 1 && mt76_rev(&dev->mt76) >= MT76XX_REV_E3 && 396427f9ebeSLorenzo Bianconi !(txwi->rate & cpu_to_le16(rate_ht_mask))) 397427f9ebeSLorenzo Bianconi txwi->txstream = 0x93; 398427f9ebeSLorenzo Bianconi 399427f9ebeSLorenzo Bianconi mt76x02_mac_fill_txwi(txwi, skb, sta, len, nss); 400427f9ebeSLorenzo Bianconi } 401427f9ebeSLorenzo Bianconi EXPORT_SYMBOL_GPL(mt76x02_mac_write_txwi); 402427f9ebeSLorenzo Bianconi 4037c1f8881SStanislaw Gruszka static void 4048d66af49SLorenzo Bianconi mt76x02_mac_fill_tx_status(struct mt76x02_dev *dev, 4057c1f8881SStanislaw Gruszka struct ieee80211_tx_info *info, 4067c1f8881SStanislaw Gruszka struct mt76x02_tx_status *st, int n_frames) 4077c1f8881SStanislaw Gruszka { 4087c1f8881SStanislaw Gruszka struct ieee80211_tx_rate *rate = info->status.rates; 4097c1f8881SStanislaw Gruszka int cur_idx, last_rate; 4107c1f8881SStanislaw Gruszka int i; 4117c1f8881SStanislaw Gruszka 4127c1f8881SStanislaw Gruszka if (!n_frames) 4137c1f8881SStanislaw Gruszka return; 4147c1f8881SStanislaw Gruszka 4157c1f8881SStanislaw Gruszka last_rate = min_t(int, st->retry, IEEE80211_TX_MAX_RATES - 1); 4167c1f8881SStanislaw Gruszka mt76x02_mac_process_tx_rate(&rate[last_rate], st->rate, 4178d66af49SLorenzo Bianconi dev->mt76.chandef.chan->band); 4187c1f8881SStanislaw Gruszka if (last_rate < IEEE80211_TX_MAX_RATES - 1) 4197c1f8881SStanislaw Gruszka rate[last_rate + 1].idx = -1; 4207c1f8881SStanislaw Gruszka 4217c1f8881SStanislaw Gruszka cur_idx = rate[last_rate].idx + last_rate; 4227c1f8881SStanislaw Gruszka for (i = 0; i <= last_rate; i++) { 4237c1f8881SStanislaw Gruszka rate[i].flags = rate[last_rate].flags; 4247c1f8881SStanislaw Gruszka rate[i].idx = max_t(int, 0, cur_idx - i); 4257c1f8881SStanislaw Gruszka rate[i].count = 1; 4267c1f8881SStanislaw Gruszka } 4277c1f8881SStanislaw Gruszka rate[last_rate].count = st->retry + 1 - last_rate; 4287c1f8881SStanislaw Gruszka 4297c1f8881SStanislaw Gruszka info->status.ampdu_len = n_frames; 4307c1f8881SStanislaw Gruszka info->status.ampdu_ack_len = st->success ? n_frames : 0; 4317c1f8881SStanislaw Gruszka 4327c1f8881SStanislaw Gruszka if (st->pktid & MT_TXWI_PKTID_PROBE) 4337c1f8881SStanislaw Gruszka info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE; 4347c1f8881SStanislaw Gruszka 4357c1f8881SStanislaw Gruszka if (st->aggr) 4367c1f8881SStanislaw Gruszka info->flags |= IEEE80211_TX_CTL_AMPDU | 4377c1f8881SStanislaw Gruszka IEEE80211_TX_STAT_AMPDU; 4387c1f8881SStanislaw Gruszka 4397c1f8881SStanislaw Gruszka if (!st->ack_req) 4407c1f8881SStanislaw Gruszka info->flags |= IEEE80211_TX_CTL_NO_ACK; 4417c1f8881SStanislaw Gruszka else if (st->success) 4427c1f8881SStanislaw Gruszka info->flags |= IEEE80211_TX_STAT_ACK; 4437c1f8881SStanislaw Gruszka } 4447c1f8881SStanislaw Gruszka 4458d66af49SLorenzo Bianconi void mt76x02_send_tx_status(struct mt76x02_dev *dev, 4467c1f8881SStanislaw Gruszka struct mt76x02_tx_status *stat, u8 *update) 4477c1f8881SStanislaw Gruszka { 4487c1f8881SStanislaw Gruszka struct ieee80211_tx_info info = {}; 4497c1f8881SStanislaw Gruszka struct ieee80211_sta *sta = NULL; 4507c1f8881SStanislaw Gruszka struct mt76_wcid *wcid = NULL; 4517c1f8881SStanislaw Gruszka struct mt76x02_sta *msta = NULL; 4527c1f8881SStanislaw Gruszka 4537c1f8881SStanislaw Gruszka rcu_read_lock(); 4548d66af49SLorenzo Bianconi if (stat->wcid < ARRAY_SIZE(dev->mt76.wcid)) 4558d66af49SLorenzo Bianconi wcid = rcu_dereference(dev->mt76.wcid[stat->wcid]); 4567c1f8881SStanislaw Gruszka 4577c1f8881SStanislaw Gruszka if (wcid) { 4587c1f8881SStanislaw Gruszka void *priv; 4597c1f8881SStanislaw Gruszka 4607c1f8881SStanislaw Gruszka priv = msta = container_of(wcid, struct mt76x02_sta, wcid); 4617c1f8881SStanislaw Gruszka sta = container_of(priv, struct ieee80211_sta, 4627c1f8881SStanislaw Gruszka drv_priv); 4637c1f8881SStanislaw Gruszka } 4647c1f8881SStanislaw Gruszka 4657c1f8881SStanislaw Gruszka if (msta && stat->aggr) { 4667c1f8881SStanislaw Gruszka u32 stat_val, stat_cache; 4677c1f8881SStanislaw Gruszka 4687c1f8881SStanislaw Gruszka stat_val = stat->rate; 4697c1f8881SStanislaw Gruszka stat_val |= ((u32) stat->retry) << 16; 4707c1f8881SStanislaw Gruszka stat_cache = msta->status.rate; 4717c1f8881SStanislaw Gruszka stat_cache |= ((u32) msta->status.retry) << 16; 4727c1f8881SStanislaw Gruszka 4737c1f8881SStanislaw Gruszka if (*update == 0 && stat_val == stat_cache && 4747c1f8881SStanislaw Gruszka stat->wcid == msta->status.wcid && msta->n_frames < 32) { 4757c1f8881SStanislaw Gruszka msta->n_frames++; 4767c1f8881SStanislaw Gruszka goto out; 4777c1f8881SStanislaw Gruszka } 4787c1f8881SStanislaw Gruszka 4797c1f8881SStanislaw Gruszka mt76x02_mac_fill_tx_status(dev, &info, &msta->status, 4807c1f8881SStanislaw Gruszka msta->n_frames); 4817c1f8881SStanislaw Gruszka 4827c1f8881SStanislaw Gruszka msta->status = *stat; 4837c1f8881SStanislaw Gruszka msta->n_frames = 1; 4847c1f8881SStanislaw Gruszka *update = 0; 4857c1f8881SStanislaw Gruszka } else { 4867c1f8881SStanislaw Gruszka mt76x02_mac_fill_tx_status(dev, &info, stat, 1); 4877c1f8881SStanislaw Gruszka *update = 1; 4887c1f8881SStanislaw Gruszka } 4897c1f8881SStanislaw Gruszka 4908d66af49SLorenzo Bianconi ieee80211_tx_status_noskb(dev->mt76.hw, sta, &info); 4917c1f8881SStanislaw Gruszka 4927c1f8881SStanislaw Gruszka out: 4937c1f8881SStanislaw Gruszka rcu_read_unlock(); 4947c1f8881SStanislaw Gruszka } 4957c1f8881SStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_send_tx_status); 49674ff4539SStanislaw Gruszka 49774ff4539SStanislaw Gruszka int 49874ff4539SStanislaw Gruszka mt76x02_mac_process_rate(struct mt76_rx_status *status, u16 rate) 49974ff4539SStanislaw Gruszka { 50074ff4539SStanislaw Gruszka u8 idx = FIELD_GET(MT_RXWI_RATE_INDEX, rate); 50174ff4539SStanislaw Gruszka 50274ff4539SStanislaw Gruszka switch (FIELD_GET(MT_RXWI_RATE_PHY, rate)) { 50374ff4539SStanislaw Gruszka case MT_PHY_TYPE_OFDM: 50474ff4539SStanislaw Gruszka if (idx >= 8) 50574ff4539SStanislaw Gruszka idx = 0; 50674ff4539SStanislaw Gruszka 50774ff4539SStanislaw Gruszka if (status->band == NL80211_BAND_2GHZ) 50874ff4539SStanislaw Gruszka idx += 4; 50974ff4539SStanislaw Gruszka 51074ff4539SStanislaw Gruszka status->rate_idx = idx; 51174ff4539SStanislaw Gruszka return 0; 51274ff4539SStanislaw Gruszka case MT_PHY_TYPE_CCK: 51374ff4539SStanislaw Gruszka if (idx >= 8) { 51474ff4539SStanislaw Gruszka idx -= 8; 51574ff4539SStanislaw Gruszka status->enc_flags |= RX_ENC_FLAG_SHORTPRE; 51674ff4539SStanislaw Gruszka } 51774ff4539SStanislaw Gruszka 51874ff4539SStanislaw Gruszka if (idx >= 4) 51974ff4539SStanislaw Gruszka idx = 0; 52074ff4539SStanislaw Gruszka 52174ff4539SStanislaw Gruszka status->rate_idx = idx; 52274ff4539SStanislaw Gruszka return 0; 52374ff4539SStanislaw Gruszka case MT_PHY_TYPE_HT_GF: 52474ff4539SStanislaw Gruszka status->enc_flags |= RX_ENC_FLAG_HT_GF; 52574ff4539SStanislaw Gruszka /* fall through */ 52674ff4539SStanislaw Gruszka case MT_PHY_TYPE_HT: 52774ff4539SStanislaw Gruszka status->encoding = RX_ENC_HT; 52874ff4539SStanislaw Gruszka status->rate_idx = idx; 52974ff4539SStanislaw Gruszka break; 53074ff4539SStanislaw Gruszka case MT_PHY_TYPE_VHT: 53174ff4539SStanislaw Gruszka status->encoding = RX_ENC_VHT; 53274ff4539SStanislaw Gruszka status->rate_idx = FIELD_GET(MT_RATE_INDEX_VHT_IDX, idx); 53374ff4539SStanislaw Gruszka status->nss = FIELD_GET(MT_RATE_INDEX_VHT_NSS, idx) + 1; 53474ff4539SStanislaw Gruszka break; 53574ff4539SStanislaw Gruszka default: 53674ff4539SStanislaw Gruszka return -EINVAL; 53774ff4539SStanislaw Gruszka } 53874ff4539SStanislaw Gruszka 53974ff4539SStanislaw Gruszka if (rate & MT_RXWI_RATE_LDPC) 54074ff4539SStanislaw Gruszka status->enc_flags |= RX_ENC_FLAG_LDPC; 54174ff4539SStanislaw Gruszka 54274ff4539SStanislaw Gruszka if (rate & MT_RXWI_RATE_SGI) 54374ff4539SStanislaw Gruszka status->enc_flags |= RX_ENC_FLAG_SHORT_GI; 54474ff4539SStanislaw Gruszka 54574ff4539SStanislaw Gruszka if (rate & MT_RXWI_RATE_STBC) 54674ff4539SStanislaw Gruszka status->enc_flags |= 1 << RX_ENC_FLAG_STBC_SHIFT; 54774ff4539SStanislaw Gruszka 54874ff4539SStanislaw Gruszka switch (FIELD_GET(MT_RXWI_RATE_BW, rate)) { 54974ff4539SStanislaw Gruszka case MT_PHY_BW_20: 55074ff4539SStanislaw Gruszka break; 55174ff4539SStanislaw Gruszka case MT_PHY_BW_40: 55274ff4539SStanislaw Gruszka status->bw = RATE_INFO_BW_40; 55374ff4539SStanislaw Gruszka break; 55474ff4539SStanislaw Gruszka case MT_PHY_BW_80: 55574ff4539SStanislaw Gruszka status->bw = RATE_INFO_BW_80; 55674ff4539SStanislaw Gruszka break; 55774ff4539SStanislaw Gruszka default: 55874ff4539SStanislaw Gruszka break; 55974ff4539SStanislaw Gruszka } 56074ff4539SStanislaw Gruszka 56174ff4539SStanislaw Gruszka return 0; 56274ff4539SStanislaw Gruszka } 56374ff4539SStanislaw Gruszka EXPORT_SYMBOL_GPL(mt76x02_mac_process_rate); 56489a8607cSLorenzo Bianconi 5658d66af49SLorenzo Bianconi void mt76x02_mac_setaddr(struct mt76x02_dev *dev, u8 *addr) 56689a8607cSLorenzo Bianconi { 5678d66af49SLorenzo Bianconi ether_addr_copy(dev->mt76.macaddr, addr); 56889a8607cSLorenzo Bianconi 5698d66af49SLorenzo Bianconi if (!is_valid_ether_addr(dev->mt76.macaddr)) { 5708d66af49SLorenzo Bianconi eth_random_addr(dev->mt76.macaddr); 5718d66af49SLorenzo Bianconi dev_info(dev->mt76.dev, 57289a8607cSLorenzo Bianconi "Invalid MAC address, using random address %pM\n", 5738d66af49SLorenzo Bianconi dev->mt76.macaddr); 57489a8607cSLorenzo Bianconi } 57589a8607cSLorenzo Bianconi 5768d66af49SLorenzo Bianconi mt76_wr(dev, MT_MAC_ADDR_DW0, get_unaligned_le32(dev->mt76.macaddr)); 5778d66af49SLorenzo Bianconi mt76_wr(dev, MT_MAC_ADDR_DW1, 5788d66af49SLorenzo Bianconi get_unaligned_le16(dev->mt76.macaddr + 4) | 57989a8607cSLorenzo Bianconi FIELD_PREP(MT_MAC_ADDR_DW1_U2ME_MASK, 0xff)); 58089a8607cSLorenzo Bianconi } 58189a8607cSLorenzo Bianconi EXPORT_SYMBOL_GPL(mt76x02_mac_setaddr); 582d9f8934eSLorenzo Bianconi 583d9f8934eSLorenzo Bianconi static int 584d9f8934eSLorenzo Bianconi mt76x02_mac_get_rssi(struct mt76x02_dev *dev, s8 rssi, int chain) 585d9f8934eSLorenzo Bianconi { 586d9f8934eSLorenzo Bianconi struct mt76x02_rx_freq_cal *cal = &dev->cal.rx; 587d9f8934eSLorenzo Bianconi 588d9f8934eSLorenzo Bianconi rssi += cal->rssi_offset[chain]; 589d9f8934eSLorenzo Bianconi rssi -= cal->lna_gain; 590d9f8934eSLorenzo Bianconi 591d9f8934eSLorenzo Bianconi return rssi; 592d9f8934eSLorenzo Bianconi } 593d9f8934eSLorenzo Bianconi 594d9f8934eSLorenzo Bianconi int mt76x02_mac_process_rx(struct mt76x02_dev *dev, struct sk_buff *skb, 595d9f8934eSLorenzo Bianconi void *rxi) 596d9f8934eSLorenzo Bianconi { 597d9f8934eSLorenzo Bianconi struct mt76_rx_status *status = (struct mt76_rx_status *) skb->cb; 598d9f8934eSLorenzo Bianconi struct mt76x02_rxwi *rxwi = rxi; 599d9f8934eSLorenzo Bianconi struct mt76x02_sta *sta; 600d9f8934eSLorenzo Bianconi u32 rxinfo = le32_to_cpu(rxwi->rxinfo); 601d9f8934eSLorenzo Bianconi u32 ctl = le32_to_cpu(rxwi->ctl); 602d9f8934eSLorenzo Bianconi u16 rate = le16_to_cpu(rxwi->rate); 603d9f8934eSLorenzo Bianconi u16 tid_sn = le16_to_cpu(rxwi->tid_sn); 604d9f8934eSLorenzo Bianconi bool unicast = rxwi->rxinfo & cpu_to_le32(MT_RXINFO_UNICAST); 605d9f8934eSLorenzo Bianconi int i, pad_len = 0, nstreams = dev->mt76.chainmask & 0xf; 606d9f8934eSLorenzo Bianconi s8 signal; 607d9f8934eSLorenzo Bianconi u8 pn_len; 608d9f8934eSLorenzo Bianconi u8 wcid; 609d9f8934eSLorenzo Bianconi int len; 610d9f8934eSLorenzo Bianconi 611d9f8934eSLorenzo Bianconi if (!test_bit(MT76_STATE_RUNNING, &dev->mt76.state)) 612d9f8934eSLorenzo Bianconi return -EINVAL; 613d9f8934eSLorenzo Bianconi 614d9f8934eSLorenzo Bianconi if (rxinfo & MT_RXINFO_L2PAD) 615d9f8934eSLorenzo Bianconi pad_len += 2; 616d9f8934eSLorenzo Bianconi 617d9f8934eSLorenzo Bianconi if (rxinfo & MT_RXINFO_DECRYPT) { 618d9f8934eSLorenzo Bianconi status->flag |= RX_FLAG_DECRYPTED; 619d9f8934eSLorenzo Bianconi status->flag |= RX_FLAG_MMIC_STRIPPED; 620d9f8934eSLorenzo Bianconi status->flag |= RX_FLAG_MIC_STRIPPED; 621d9f8934eSLorenzo Bianconi status->flag |= RX_FLAG_IV_STRIPPED; 622d9f8934eSLorenzo Bianconi } 623d9f8934eSLorenzo Bianconi 624d9f8934eSLorenzo Bianconi wcid = FIELD_GET(MT_RXWI_CTL_WCID, ctl); 625d9f8934eSLorenzo Bianconi sta = mt76x02_rx_get_sta(&dev->mt76, wcid); 626d9f8934eSLorenzo Bianconi status->wcid = mt76x02_rx_get_sta_wcid(sta, unicast); 627d9f8934eSLorenzo Bianconi 628d9f8934eSLorenzo Bianconi len = FIELD_GET(MT_RXWI_CTL_MPDU_LEN, ctl); 629d9f8934eSLorenzo Bianconi pn_len = FIELD_GET(MT_RXINFO_PN_LEN, rxinfo); 630d9f8934eSLorenzo Bianconi if (pn_len) { 631d9f8934eSLorenzo Bianconi int offset = ieee80211_get_hdrlen_from_skb(skb) + pad_len; 632d9f8934eSLorenzo Bianconi u8 *data = skb->data + offset; 633d9f8934eSLorenzo Bianconi 634d9f8934eSLorenzo Bianconi status->iv[0] = data[7]; 635d9f8934eSLorenzo Bianconi status->iv[1] = data[6]; 636d9f8934eSLorenzo Bianconi status->iv[2] = data[5]; 637d9f8934eSLorenzo Bianconi status->iv[3] = data[4]; 638d9f8934eSLorenzo Bianconi status->iv[4] = data[1]; 639d9f8934eSLorenzo Bianconi status->iv[5] = data[0]; 640d9f8934eSLorenzo Bianconi 641d9f8934eSLorenzo Bianconi /* 642d9f8934eSLorenzo Bianconi * Driver CCMP validation can't deal with fragments. 643d9f8934eSLorenzo Bianconi * Let mac80211 take care of it. 644d9f8934eSLorenzo Bianconi */ 645d9f8934eSLorenzo Bianconi if (rxinfo & MT_RXINFO_FRAG) { 646d9f8934eSLorenzo Bianconi status->flag &= ~RX_FLAG_IV_STRIPPED; 647d9f8934eSLorenzo Bianconi } else { 648d9f8934eSLorenzo Bianconi pad_len += pn_len << 2; 649d9f8934eSLorenzo Bianconi len -= pn_len << 2; 650d9f8934eSLorenzo Bianconi } 651d9f8934eSLorenzo Bianconi } 652d9f8934eSLorenzo Bianconi 653d9f8934eSLorenzo Bianconi mt76x02_remove_hdr_pad(skb, pad_len); 654d9f8934eSLorenzo Bianconi 655d9f8934eSLorenzo Bianconi if ((rxinfo & MT_RXINFO_BA) && !(rxinfo & MT_RXINFO_NULL)) 656d9f8934eSLorenzo Bianconi status->aggr = true; 657d9f8934eSLorenzo Bianconi 658d9f8934eSLorenzo Bianconi if (WARN_ON_ONCE(len > skb->len)) 659d9f8934eSLorenzo Bianconi return -EINVAL; 660d9f8934eSLorenzo Bianconi 661d9f8934eSLorenzo Bianconi pskb_trim(skb, len); 662d9f8934eSLorenzo Bianconi 663d9f8934eSLorenzo Bianconi status->chains = BIT(0); 664d9f8934eSLorenzo Bianconi signal = mt76x02_mac_get_rssi(dev, rxwi->rssi[0], 0); 665d9f8934eSLorenzo Bianconi for (i = 1; i < nstreams; i++) { 666d9f8934eSLorenzo Bianconi status->chains |= BIT(i); 667d9f8934eSLorenzo Bianconi status->chain_signal[i] = mt76x02_mac_get_rssi(dev, 668d9f8934eSLorenzo Bianconi rxwi->rssi[i], 669d9f8934eSLorenzo Bianconi i); 670d9f8934eSLorenzo Bianconi signal = max_t(s8, signal, status->chain_signal[i]); 671d9f8934eSLorenzo Bianconi } 672d9f8934eSLorenzo Bianconi status->signal = signal; 673d9f8934eSLorenzo Bianconi status->freq = dev->mt76.chandef.chan->center_freq; 674d9f8934eSLorenzo Bianconi status->band = dev->mt76.chandef.chan->band; 675d9f8934eSLorenzo Bianconi 676d9f8934eSLorenzo Bianconi status->tid = FIELD_GET(MT_RXWI_TID, tid_sn); 677d9f8934eSLorenzo Bianconi status->seqno = FIELD_GET(MT_RXWI_SN, tid_sn); 678d9f8934eSLorenzo Bianconi 679d9f8934eSLorenzo Bianconi if (sta) { 680d9f8934eSLorenzo Bianconi ewma_signal_add(&sta->rssi, status->signal); 681d9f8934eSLorenzo Bianconi sta->inactive_count = 0; 682d9f8934eSLorenzo Bianconi } 683d9f8934eSLorenzo Bianconi 684d9f8934eSLorenzo Bianconi return mt76x02_mac_process_rate(status, rate); 685d9f8934eSLorenzo Bianconi } 6863e2342edSLorenzo Bianconi 6873e2342edSLorenzo Bianconi void mt76x02_mac_poll_tx_status(struct mt76x02_dev *dev, bool irq) 6883e2342edSLorenzo Bianconi { 6893e2342edSLorenzo Bianconi struct mt76x02_tx_status stat = {}; 6903e2342edSLorenzo Bianconi unsigned long flags; 6913e2342edSLorenzo Bianconi u8 update = 1; 6923e2342edSLorenzo Bianconi bool ret; 6933e2342edSLorenzo Bianconi 6943e2342edSLorenzo Bianconi if (!test_bit(MT76_STATE_RUNNING, &dev->mt76.state)) 6953e2342edSLorenzo Bianconi return; 6963e2342edSLorenzo Bianconi 6973e2342edSLorenzo Bianconi trace_mac_txstat_poll(dev); 6983e2342edSLorenzo Bianconi 6993e2342edSLorenzo Bianconi while (!irq || !kfifo_is_full(&dev->txstatus_fifo)) { 7003e2342edSLorenzo Bianconi spin_lock_irqsave(&dev->mt76.mmio.irq_lock, flags); 7018d66af49SLorenzo Bianconi ret = mt76x02_mac_load_tx_status(dev, &stat); 7023e2342edSLorenzo Bianconi spin_unlock_irqrestore(&dev->mt76.mmio.irq_lock, flags); 7033e2342edSLorenzo Bianconi 7043e2342edSLorenzo Bianconi if (!ret) 7053e2342edSLorenzo Bianconi break; 7063e2342edSLorenzo Bianconi 7073e2342edSLorenzo Bianconi trace_mac_txstat_fetch(dev, &stat); 7083e2342edSLorenzo Bianconi 7093e2342edSLorenzo Bianconi if (!irq) { 7108d66af49SLorenzo Bianconi mt76x02_send_tx_status(dev, &stat, &update); 7113e2342edSLorenzo Bianconi continue; 7123e2342edSLorenzo Bianconi } 7133e2342edSLorenzo Bianconi 7143e2342edSLorenzo Bianconi kfifo_put(&dev->txstatus_fifo, stat); 7153e2342edSLorenzo Bianconi } 7163e2342edSLorenzo Bianconi } 7173e2342edSLorenzo Bianconi EXPORT_SYMBOL_GPL(mt76x02_mac_poll_tx_status); 718466495b1SLorenzo Bianconi 719466495b1SLorenzo Bianconi static void 720466495b1SLorenzo Bianconi mt76x02_mac_queue_txdone(struct mt76x02_dev *dev, struct sk_buff *skb, 721466495b1SLorenzo Bianconi void *txwi_ptr) 722466495b1SLorenzo Bianconi { 723466495b1SLorenzo Bianconi struct mt76x02_tx_info *txi = mt76x02_skb_tx_info(skb); 724466495b1SLorenzo Bianconi struct mt76x02_txwi *txwi = txwi_ptr; 725466495b1SLorenzo Bianconi 726466495b1SLorenzo Bianconi mt76x02_mac_poll_tx_status(dev, false); 727466495b1SLorenzo Bianconi 728466495b1SLorenzo Bianconi txi->tries = 0; 729466495b1SLorenzo Bianconi txi->jiffies = jiffies; 730466495b1SLorenzo Bianconi txi->wcid = txwi->wcid; 731466495b1SLorenzo Bianconi txi->pktid = txwi->pktid; 732466495b1SLorenzo Bianconi trace_mac_txdone_add(dev, txwi->wcid, txwi->pktid); 733466495b1SLorenzo Bianconi mt76x02_tx_complete(&dev->mt76, skb); 734466495b1SLorenzo Bianconi } 735466495b1SLorenzo Bianconi 736466495b1SLorenzo Bianconi void mt76x02_tx_complete_skb(struct mt76_dev *mdev, struct mt76_queue *q, 737466495b1SLorenzo Bianconi struct mt76_queue_entry *e, bool flush) 738466495b1SLorenzo Bianconi { 739466495b1SLorenzo Bianconi struct mt76x02_dev *dev = container_of(mdev, struct mt76x02_dev, mt76); 740466495b1SLorenzo Bianconi 741466495b1SLorenzo Bianconi if (e->txwi) 742466495b1SLorenzo Bianconi mt76x02_mac_queue_txdone(dev, e->skb, &e->txwi->txwi); 743466495b1SLorenzo Bianconi else 744466495b1SLorenzo Bianconi dev_kfree_skb_any(e->skb); 745466495b1SLorenzo Bianconi } 746466495b1SLorenzo Bianconi EXPORT_SYMBOL_GPL(mt76x02_tx_complete_skb); 747